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4 

GENERAL  INFORMATION 

"Methods  of  Astrodynamics"  is  designed  to  provide  PASCAL  and  FORTRAN  source  code  for  various 
Astrodynamic  routines.  The  paper  does  NOT  derive  any  of  the  formulas  as  the  referenced  texts  do  this  in 
great  detail.  The  reader  should  be  aware  that  the  variety  of  sources  is  necessary  to  obtain  a  "complete” 
understanding  of  each  algorithm.  I  have  used  three  main  texts  in  the  development  of  these  routines.  The 
references  are  listed  in  order  of  their  relative  completeness  in  describing  each  problem. 

Bate,  Roger  R.,  Mueller,  Donald  D.,  and  White,  Jerry  E.,  Fundamentals  of  Aatrodynamhx,  New  York,  Dover 

Publications,  1970. 

Escobal,  Pedro  R.,  Methods  of  Orbit  Determination,  John  Wiley  k  Sons,  New  York  1965,  Reprint  Edition  Kreiger 

Publishing  Co,  Malabar  FL  ,  1979 

Kaplan,  Marshall  H.,  Modena  Spacecraft  Dynamics  and  Coutrol,  New  York,  John  Wiley  k  Sons,  1976. 

Unit  systems  present  a  problem  in  almost  every  application  of  these  procedures  since  each  problem  has 
different  units.  For  this  reason,  I  have  programmed  the  routines  to  use  canonical  units,  and  radians 
exclusively.  Every  calculation  uses  these  units,  and  any  conversions  are  performed  before  the  procedure  is 
called.  An  added  benefit  of  canonical  units  is  their  relative  magnitudes.  By  acting  almost  like  a  scaling 
factor,  the  magnitudes  of  the  numbers  are  reduced  to  much  smaller  scalar-like  values.  In  addition,  the 
Gravitational  Parameter  of  the  Earth  appears  in  many  places  in  the  equations.  The  use  of  the  canonical 
system  defines  the  Gravitational  Parameter  of  the  Earth  as  1.0,  which  eliminates  a  great  deal  of  code.  Care 
should  be  exercised  if  the  procedures  are  converted  to  work  in  a  different  unit  system.  Table  1  lists  the 
constants  used  in  these  programs.  All  these  variables  have  been  derived  from  the  World  Geodetic  Survey 
1984.  This  was  accomplished  using  the  three  "base”  values:  equatorial  radius  (ft),  rotational  velocity  of  the 
Earth,  and  the  Gravitational  Parameter  of  the  Earth.  If  it  is  desired  to  change  these  conversions  and 
constants,  be  sure  to  update  s!)  of  the  parameters. 

Rotational  Velocity  of  the  Earth  7.292115  x  10*®  rad/i 

Gravitational  Parameter  of  the  Earth  3.986005  x  10®  km3/»2 

Several  "standard  coordinate  systems  are  used  throughout  this  paper.  The  Geocentric  Equatorial  (UK) 
system  refers  to  the  Earth  centered  system  with  the  I  axis  pointing  to  the  Vernal  Equinox  and  the  J  axis 
perpendicular  in  the  orbital  plane.  The  K  axis  is  normal  to  both  I  and  J  and  points  through  the  North  Pole. 
Next,  the  Topocentric  Horizon  (SEZ)  system  is  used  for  routines  simulating  radar  sites.  In  this  system,  the 
S  axis  points  due  South  from  the  site,  and  the  E  axis  points  due  East.  The  Z  axis  points  straight  up  from 
the  site  and  is  parallel  to  the  position  vector.  Escobal  presents  an  excellent  discussion  of  the  various 
coordinate  system  in  Chapter  4  of  his  book. 

The  computer  code  was  designed  to  be  as  compatible  as  possible  between  different  computers.  To  this 
end,  I  have  adopted  several  features  in  my  code  to  facilitate  any  conversion.  The  code  presented  will  run 
under  TURBO  PASCAL  Ver5.5,  MICROSOFT  FORTRAN  Ver  5.0  and  VAX  FORTRAN  Ver  4.6. 

In  PASCAL,  I  have  tried  to  avoid  many  of  the  powerful  features  of  the  language  such  as  pointers, 
records,  and  variable  type  structures.  I  have  used  pointers  to  implement  all  my  matrix  operations  since  this 
allows  the  user  to  use  almost  any  size  matrix,  within  memory  constraints.  The  matrix  operations  are  set  up 
to  closely  resemble  "normal”  coding.  The  user  is  cautioned  to  DISPOSE  (delete)  all  matricies  when  no 
longer  used  as  iterations  can  caues  lots  of  memory  to  be  uesd.  The  PASCAL  source  code  was  developed  on 
the  Zenith  248,  DOS  3.xx,  using  Turbo  Pascal  Ver5.5.  The  code  uses  the  EXTENDED  type  for  all  REAL 
variables.  This  feature  of  Turbo  Pascal  Ver5.0  and  later,  lets  the  computer  emulate  a  math  co-processor, 
and  have  19-20  significant  digits  without  a  co-processor. 

In  FORTRAN,  I  have  included  an  IMPLICIT  NONE  declaration  in  every  SUBROUTINE  and 
FUNCTION.  This  forces  you  to  declare  all  variables,  and  should  reduce  many  errors  during  program 
writing.  The  code  was  first  developed  in  LAIIEY  FORTRAN  Ver  3.0  and  uses  several  of  the  extensions  to 
be  compatible  with  FORTRAN  90  when  it’s  released.  The  FORTRAN  code  contains  no  EQUIVALENCES, 
VERY  LIMITED  GOTOs  and  no  COMMON  blocks  in  the  subroutines  library.  This  is  designed  so  each 
SUBROUTINE  could  be  passed  all  of  the  arguments  necessary  for  its  operation. 


The  user  is  cautioned  when  trying  to  compare  EXACT  numerical  results  with  the  answers  in  this  listing. 
Numerical  accuracies  of  each  machine  are  different.  The  use  of  floating  point  math,  double  precision 
variables,  different  languages,  etc.,  all  make  minor  differences  in  the  answers.  If  strict  numerical  accuracy  is 
needed,  new  answers  may  vary  from  the  listing,  usually  in  the  5th  or  6th  decimal  place. 

Technically,  I  have  designed  these  routines  to  be  compatible  with  a  variety  of  orbit  types.  To  this  end, 
the  RandV  procedure  uses  ”p”  (semi-parameter  or  semi-iatus  rectum)  as  it’s  input.  This  even  allows 
calculations  for  parabolic  orbits.  I  have  also  used  Julian  Date  as  the  standard  time  variable  between  all 
routines.  This  simplifies  many  operations,  and  allows  procedures  like  Herrick-Gibbs  procedures  to  function 
across  two  days  if  the  sightings  occur  near  local  midnight.  ' 

I  have  not  included  any  driver  programs  since  these  routines  are  designed  to  be  a  library  which  one  may 
attach  to  the  main  program.  In  pascal,  each  file  contains  similar  routines,  time,  orbit  determination,  etc., 
and  each  is  set  up  as  a  .TPU  file  (  TURBO  PASCALs  Unit  structure  )  so  the  code  does  not  have  to  be 
compiled  each  time.  Likewise,  the  FORTRAN  routines  are  organized  the  same  way,  and  may  be  included  at 
the  linking  step  in  program  developement. 

Finally,  although  I  have  tried  to  anticipate  any  singularities  and  problem  areas  in  the  procedures,  an 
exhaustive  search  is  virtually  impossible.  For  this  reason,  the  Department  of  Astronautics  at  the  USAFA, 
and  I,  cannot  take  responsibility  for  maintenance  and  upkeep  of  these  procedures.  If  problems  do  occur, 
please  notify 

HQ  USAFA  /  DFAS  Com’l  (719)  472-4109 

Attn:  Capt  Dave  Vallado  Autovon  259-4109 

US  Air  Force  Academy,  CO.  80840-5701 

for  possible  assistance  and  documentation/code  changes.  Finally,  I  would  appreciate  notification  of 
enhancements  designed  around  these  routines  for  possible  inclusion  into  future  versions  of  this  software. 
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World  Geodetic  Survey  1984 

NOTE:  ALL  time*  are  for  SIDEREAL  time,  except  aa  acted. 


MEANEQUATORIALRApnJS; 


1.0  DU 


* 

1.0  AU 


20925646.325459318  ft 

3963.190591943  miles 
3443.91S466523  NM 
6378.137000000  km 
149599650.0  km 


..  .»  v"  i.' ''s  ' 


1.0  TU 


V1990 

et0  1992 

V1993 

<?gol094 


1.0 


DU 


TU 


13.44685108204 

806.81106492270 

0.00933809102919444 
100.3836180* 
100.1449058  * 
99.9061937  * 
100.6531291  * 
100.4144172  * 


Min 

Sec 

Days 


a 


'V 


^hSPBEP- 


25936.241129097825 

7.905366296149 


,\m 


OIUVITATIONALPARAMETERI; 


i.o  eyj 

TU2 

= 

rt3 

14076443812518712.80  3 

398600.500db000  IS" 

r 

c 

0.05883359068688786  ^ 

“e 

ss 

0.25068444793441402  ^ 
mm 

= 

0.00007292115000000  £fr 

= 

6.30038809866574 

C 

■  /.  '  ■'  .SHAPE.;  •'  ,, 

Semi-Minor  Axis 

6356.752314200  km 

«e 

Eccentricity  of  Earth 

= 

0.08181919034260  e*  =  0.00669437999013 

f 

Flatenning  of  Earth 

= 

1.0  /  298.257223563  =  0.003352810664747352 

J2 

0.00108263 

J3 

= 

-0.00000254 

J4 

-0.00000161 

* 

indicates  defining  parameter  for  WGS-84 

U 

CONVERSIONS  '  .  | 

FtToKM 

0.0003048 

NmToKm 

r= 

1.8520 

MilesToKm 

= 

1.6093440 

FtToMiles 

=: 

1.0  /  5280.0 

ir 

1.57079632679490 

* 

jr 

3.14159265358979 

2  sr 

= 

6.28318530717959 

1.0  radian 

— 

57.29577951308230* 

1.0  S? 

= 

1.0  /  0.0710151137039398 

v 
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JULIANDAY  ( Yr,Mon,D,H,M,Sec,  JD  ) 


This  procedure  finds  the  Julian  date  given  the  Year,  Month,  Day,  and  Time.  The  Julian  date  is  defined  by  each  elapsed  day 
since  noon,  1  Jan  4713  BC.  Julian  dates  are  measured  from  this  epoch  at  noon  so  astronomers  observations  may  be  performed 
on  a  single  "day”.  The  year  range  is  limited  since  machine  routines  for  365  days  a  year  and  leap  yea re  are  valid  in  this  range 
only.  This  is  due  to  the  fact  that  leap  years  occur  only  in  years  divisible  by  4  and  centuries  whose  number  is  evenly  divisible  by 
400.  (  1900  no,  2000  ye*  ... ) 

NOTE:  This  Algorithm  is  taken  from  the  1988  Almanac  for  Computers,  Published  by  the  U.S.  Naval  Observatory.  The 
algorithm  is  good  for  dates  between  1  Mar  1900  to  28  Feb  2100  since  the  last  two  terms  (from  the  Almanac)  are  commented  out. 


Variable 

Range 

Inputs  :  Yr 

Year 

1900  ..  2100 

Mon 

Month 

1  ..  12 

D 

Day 

1  ..  28,29,30,31 

H 

Universal  Time  Hoar 

0  ..  23 

M 

Universal  Time  Min 

0  ..  59 

Sec 

Universal  Time  Sec 

0.0  ..  59.999 

Outputs  :  JD 

Julian  Date 

days  from  4713  B.C 

References  : 

1988  Almanac  for  Computers  pg.  B2 
Escobal  pg.  17*19 

Kaplan  pg.  329-330 


JDatc  =  367  (Yr) 


'inif(Yt  +  1NT4(M^ 


+  INt(  2?5-^n  )  +  Day 


+ 


1721013.5 


+ 


( 


(W  +  Min  A 

6(5  j 
- S3 — 


+ 


Hr 


l 


This  function  find*  the  Greenwich  Sidereal  time, 
calculation. 


GSTIME  ( JJD  ) 

V 

Notice  juit  the  integer  part  of  the  Julian  Date  is  used  for  the  Julian  centuries 


Variable  Range 

Inputs  :  JD  -  Julian  Date  days  from  4713  B.C. 

OutPuts  :  GSTime  •  GST  Greenwich  Sidereal  Time  0.0  to  IT  rad 

Locals  :  Tu  -  Julian  Centuries  from  1  Jan  2000 

Constants  : 

RadPerDay  Radians  the  earth  rotate*  in  1  sidereal  day  6.30038809866S74 

Reference*  : 

1988  Almanac  for  Computers  pg.  B2 

1989  Nautical  Almanac  pg.  B6 

Eacobal  pg.  18  -  21 

Kaplan  pg.  330-332 

BMW  pg.  103-104 


Two  Primary  methods. 

1.  Use  Julian  Date.  -  Preferred  since  one  value  may  be  used  throughout  many  years. 

Tu  =  — D  (Note  U8C  of  Epoch  :  1  Jan  200°) 

GST0  =  1.753368559  +  628.3319705Tu  +  6.77070812rO6Tu1  radians 

GST0  =  100.4606184  +  36000.77004Tu  +  0.00038793Tu2  degrees 

GST  —  GST0  +  RadPerDay(  Fraction(  JDate  )  ) 

2.  Use  tables  for  a  particular  year.  Requires  knowledge  of  GST  at  some  Epoch. 

Look  up  value  for  GST0  for  1  Jan,  0  Hr  of  the  given  year. 

GST  =  GST0  +  1.0027379093  (2*)  (  DayofYr  +  gf  +  ^  +  gffjjg ) 

Notice  the  day  of  year  is  really  (  Day  -  1  )  since  the  epoch  is  1  Jan 

Don’t  forget  the  result  is  MODed  by  2*  since  the  equations  give  the  radians  since  the  epoch. 


2 


LSTIME  (  Lon, JO,  Lst.Gst ) 

This  procedure  finds  the  Local  Sidereal  time  at  a  given  location. 


Variable 

Inputs  :  Lon 

- 

Site  longitude  (WEST  -) 

JD 

Julian  Date 

OutPuts  :  LST 

Local  Sidereal  Time 

GST 

. 

Greenwich  Sidereal  Time 

Coupling  : 

GSTime  Finds  the  Greenwich  Sidereal  Time 


References  : 
Escobal 
Kaplan 
BMW 


Range 

-2JT  to  25T  rad 
days  from  <713  B.C. 

0.0  to  27T  rad 
0.0  to  2X  rad 


pg.  18  -  21 
pg.  330-332 

pg.  99  -100  Diagram  pg.  100 


SITE  (  Lat,Alt,L$|f,  RS,VS  ) 

Thii  procedure  fin  dr  the  pueition  and  velocity  vectore  for  a  tite.  dlie  anaerer  it  returned  in  the  Geocentric  Equatorial  (IJK) 
coordinate  system. 


Variable 

Range 

Inputs  :Lat 

•  Geodetic  Latitude 

-7T/2  to  ir/2  rad 

Alt 

-  Altitude 

DUs 

LST 

Local  Sidereal  Time 

0.0  to  27T  rad 

OutPuts  -RS 

-  RS.jjj  Site  position  vector 

DU 

VS 

-  VSjjk  Site  velocity  vector 

DU  /  TU 

Locals  : 

X 

•  x  component  of  site  vector 

DU 

x 

-  x  component  of  site  vector 

DU 

Constants 


EESqrd 


References 

Escobal 

Kaplan 

BMW 


J 


OmegaEarth  -  U) 


ffi 


Mean  Equatorial  Radius  of  the  Earth 
Eccentricity  of  Earths  shape  squared 
Angluar  Rotation  of  the  Earth 


pg.  26  •  29  (includes  Geocentric  Lat  formulation  also) 
pg.  334-336 

pg.  94  -  98  Diagram  pg.  99 


1.0  DU 

0.00669437999013 
0.058833590688786  rad/TU 


RVtoPOS  ( rho.az.el.drho.daz.del,  RhoVec.DRhoVec  ) 

This  procedure  find*  range  and  velocity  vector*  for  a  satellite  from  a  radar  site  in  the  Topocentric  Horizon  (SBZ)  system. 


Variable 

Range 

Input* 

:Rho 

■P 

Satellite  range  from  site 

DUs 

Az 

Azimuth 

0.0  to  27T  rad 

El 

Elevation 

-7T/2  to  5T/2  rad 

DRho 

•P 

Range  Rate 

DU/TU 

DAz 

-  Az 

Azimuth  Rate 

rad/TU 

DEI 

-Ei 

Elevation  rate 

rad/TU 

Outputs 

:RhoVec 

“  P sez 

Satellite  range  vector 

DU 

DRhoVec 

'Psez 

Satellite  velocity  vector 

DU/TU 

References  : 

BMW  pg.  84  -  85  Diagram  pg.  84 


P&ez  ~~ 


-pCos(  el )  Cos(  az  ) 
p  Coa(  el )  Sin(  az  ) 
p  Sin(  el ) 


Psez  ~ 


-pCos(  el  )Cos(  az  )  +  pSin(  el  )Cos(  az  )ei  +  pCos(  el  )Sin(  az  )az 
p  Cos(  el  )Sin(  az  )  -  pSin(  el  )Sin(  az  )ei  +  pCos(  el  )Cos(  az  )az 
p  S'm(  el )  +  pCos(  cl  )ei 


(  North) 
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TRACK  ( rho^z.el.drho.daz.del.Lat.LST.RS,  R,V  ) 

This  procedure  find*  range  and  velocity  vector*  in  the  Geocentric  Equatorial  (IJK)  system  given  input  from  a  radar  site. 


Inputs 

:Rho 

’P 

Variable 

Satellite  range  from  site 

Range 

DUs 

Az 

- 

Azimuth 

0.0  to  27T  rad 

El 

- 

Elevation 

-jr/2  to  7T/2  rad 

DRho 

*  P 

Range  Rate 

DU/TU 

DAz 

-  Az 

Azimuth  Rate 

rad/TU 

DEI 

-Ei 

Elevation  rate 

rad/TU 

Lat 

- 

Geodetic  Latitude 

-JT/2  to  ?r/2  rad 

LST 

- 

Local  Sidereal  Time 

0.0  to  2?  rad 

RS 

Site  position  vector 

DU 

Outputs 

:R 

*fijk 

Satellite  position  vector 

DU 

V 

-Vijlc 

Satellite  velocity  vector 

DU/TU 

Locals 

RhoVec 

-?se» 

range  vector  from  site 

DU 

DRhoVec 

'Pm 

velocity  vector  from  site 

DU/TU 

RlioV 

'  P\}V 
*^ijk 

range  vector  from  site 

DU 

DRhoV 

velocity  vector  from  site 

DU  /  TU 

Constants 


Omega£arthuo  Angluar  Rotation  of  the  Earth  0.058833590G88786  rad/TU 

Coupling  : 

RVToPo*  Find  R  and  V  from  site  in  Topocentric  Horizon  (SEZ)  system 

References  : 

BMW  pg.  85-89, 100-101  Diagram  pg.  88 
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RAZEL  (  R.V.Lat.LST.RS,  rho.az.el.drho.daz.del ) 


This  procedure  calculates  Range  Azimuth  and  Elevation  and  their  rates  given  the  Geocentric  Equatorial  (IJK)  Position  and 
Velocity  vectors. 


Variable 

Range 

Inputs 

:R 

'  ?ijk 

Position  Vector 

DU 

V 

•7ijk 

Velocity  Vector 

DU/TU 

Lat 

Geodetic  Latitude 

-ir/2  to  7T/2  rad 

LST 

Local  Sidereal  Time 

0.0  to  X  rad 

RS 

Site  Position  Vector 

DU 

Outputs 

:Rho 

•P 

satellite  range  from  site 

DUs 

Az 

Azimuth 

0.0  to  2JT  rad 

El 

Elevation 

-7T/2  to  7T/2  rad 

DRho 

•  P 

Range  Rate 

DU/TU 

DAz 

-  Az 

Azimuth  Rate 

rad/TU 

DEI 

-  Ei 

Elevation  rate 

rad/TU 

Locals 

RhoV 

•?ijk 

Range  Vector  from  site 

DU 

DRhoV 

■Pjv 

Velocity  Vector  from  site 

DU/TU 

RhoVec 

~  fLitz 

Range  vector  from  site 

DU 

DRhoVec 

*  Pttt 

Velocity  vector  from  site 

DU/TU 

Constants  : 

0megaEarthb>o  Angluar  Rotation  of  the  Earth  0.058833590688786  rad/TU 


References  : 
BMW 


pg.  84-89,  100-101 


^ijk  "  rijk  ^ijk 


wx“r  = 


lilXt 


I 


Sin(lat)Coe(lst) 

Sin(lat)Sin(lst) 

-Cos(lat) 

Psez  ~ 

-Sin(lst) 

Coa(lst) 

0 

Cos(lat)Cos(lst) 

Co«(lat)Sin(lst) 

Sin(lat) 

Sin(lat)Co8(lst) 

Sin(lat)Sin(lst) 

-Cos(lat) 

Psez  = 

-Sin(lst) 

Co8(lst) 

0 

Co#(lat)Cos(lst) 

Cos(lat)Sin(lst) 

Sin(lat) 

El  =  ATan2(-^-, 

Z) 

Az  =  ATan2  (  . .  Pt 

-b. ...  ) 

N  Ps  +  Pe 

i  A  *  / 

NPs  +  Pe 

^ijk 


Rate  terms  are  found  by  rearranging  relations  in  procedure  RVTOPOS 
.  Psez  '  Psez 

p  =  - p 


Az  = 


PjPj-PjPi 

2  ~~r 

p\  +  p\ 


El  = 


-  p  Sin  (  El ) 


nK 


+  Pt 
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ELORB  (  R,V,  p.a.e.inCpOmega.Argp.Nuo.M^.I.CapPi ) 

This  procedure  finds  the  classical  orbital  elements  given  the  Geocentric  Equatorial  Position  and  Velocity  vectors.  Special  cases 
for  equatorial  and  circular  orbits  are  also  handled. 


Variable 

Range 

Inputs  :R 

-f 

IJK  Position  vector 

DU 

V 

-  V 

IJK  Velocity  vector 

DU/TU 

Outputs  :p 

Semi-latus  rectum 

DU 

a 

semi-major  axis 

DU 

e 

eccentricity 

inc 

-  i 

inclination 

0.0  to  ft  rad 

Omega 

-fi 

Longitude  of  Ascending  Node 

0.0  to  2ft  rad 

Argp 

-  u 

Argument  of  Perigee 

0.0  to  2ft  rad 

Nuo 

-  V 

True  anomaly 

0.0  to  2ft  rad 

u 

Argument  of  Latitude 

(Cl) 

0.0  to  2ft  rad 

1 

True  Longitude 

(CB) 

0.0  to  2ft  rad 

CapPi 

-n 

Longitude  of  Periapsis 

(EE) 

0.0  to  2ft  rad 

M 

Mean  Anomaly 

0.0  to  2JT  rad 

Locals  : 

Hbar 

-h 

Angular  Momentum 

DU2 / TU 

Ebar 

-  e 

Eccentricity 

Nbar 

-  n 

Line  of  Nodes 

SMB 

-6 

Specfic  Mechanical  Energy 

DU2  /  TU2 

References  : 

BMW 

pg.  58 

-  71 

Escobal 

pg.  104-107 

Kaplan 

pg.  29 

-37 

h  =  r  x  v 
IT  =  k  x  h 


c  =  -i[(v2- 

-4)r  -  (f  •  v) v  ] 

1 

II 

*0 

1 

a  =  S5 

p  =  IT 

i  =  Coa  "1 

‘  k  -K  1 

mrj 

i  is  alwaya  .between  0.0  and  t 

» 

II 

o 

8 

t 

M 

f  i,*  B  1 

If  n[j]  <  0  Then  fl  =  2x  -  fl 

Lin  J 

v  =  Coa*1 

[■W3 

If  efk]  <  0  Then  u  =  2x  -  w 

II 

O 

8 

l 

[-^] 

If  r  *  V  <0  Then  v  ■=  2r  - 

Evaluate  Special  case* 

If  Circular  Inclined: 

u  =  Coa  *J  | 

n  •  rl 

L~ BT-J 

If  r[k]  <  0  Then  u  =  2x  -  u 

If  Circular  Equatorial: 

1  =  Coa*1 

i  •  F  1 

If  r[j]  <  0  Then  1  =  2*  -  1 
If  Inc  >5  Then  1  =  2x 

ir  J 

IF  Elliptical  Equatorial: 

M 

n  =  Coa*1 

i  •  e  1 

If  e[j]  <  0  Then  IT  =  2x  -  n 

.  » «  J 

If  Inc  >  ^  Then  II  =  2t 

Find  Mean  Anomaly 

IF  Hyperbolic:  .  ,  . 

t,  /  e  +  Coa  v  \ 

F  "  00,11  {  TTTC5T?  J 

M  *  e Sinh(  F )  -  f 


IF  Parabolic: 

D  =  Tan(  v  ) 

M  =  J  (  3pD  +  D3  ) 


IF  Elliptical: 

E 


i  m  i  kTA  /  'J  1  — ■  e2  Sin  v 
ATAN2l  l  +  e'Coi~ 


*  +  Coa  v  ^ 
1  +  e  Coa  ~v  ) 


M  =  E-eSin(E) 


IF  Circular: 

M  as  L  if  Circular  Equatorial 
or 

M  =:  U  if  Circular  Inclined 
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Classical  Orbit  Elements 

Ref  BMW  pg.  59 


RANDV  (  p.a.e.inc.Omega.Argp.Nuo.u.I.CapPi,  R.V  ) 


This  procedure  find*  the  position  and  velocity  vectors  in  Geocentric  Equatorial  (IJK)  system  given  the  classical  orbit  elements. 
NOTICE  P  is  used  for  calculations  and  that  A  is  not  used  at  this  time.  This  convention  allows  parabolic  orbits  to  be  treated  as 
well  as  the  other  conic  sections. 


Inputs  :  p 


a 

- 

e 

- 

inc 

-  i 

Omega 

-a 

Argp 

•  u 

Nuo 

-  V 

u 

- 

1 

- 

CapPi 

-n 

Outputs 

:R 

'  ?ijk 

V 

•Vijk 

Locals 

ftpqw 

'  rpqw 

Vpqw 

.  v 

pqw 

Variable 

Semi-latus  rectum 
semi-major  axis 
eccentricity 
inclination 

Longitude  of  Ascending  Node 
Argument  of  Perigee 
True  anomaly 
Argument  of  Latitude 
True  Longitude 
Longitude  of  Periapsis 

Position  vector 
Velocity  vector 

Position  vector 
Velocity  vector 


Range 

DU 

DU 


0.0 

to 

T  rad 

0.0 

to 

2* 

rad 

0.0 

to 

2T 

rad 

0.0 

to 

2JT 

rad 

(CI) 

0.0 

to 

2T 

rad 

(CE) 

0.0 

to 

2JT 

rad 

(EE) 

0.0 

to 

2X 

rad 

DU 

DU  /TU 


DU 

DU  /  TU 


References  : 

BMW  pg.  71-73,  80-83 

Eacobal  pg.  68-83 
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Determine  transformation  angles  for  special  cases  as: 


If  Circular  Equatorial: 

set  u  ,  fi  =  0.0  and  let  v  =  1 

If  Circular  Inclined: 

set  u  —  0.0  and  let  v  =  u 

If  Elliptical  Equatorial: 

set  0  =  0.0  and  let  u  =  II 


rpqw 


p  Cos(  v  ) 

1  +  eCos(  v  ) 

p  Sin(  v ) 

1  +  eCos(  v  ) 

0 


'pqw 


<y]p  -Sin(  v  ) 
]p  e  +  Cos(  v  ) 


0 


Cos  QCot  w— Sin  fiSin  wCo*  i 
Sin  fiCo*  w+Co#  fiSin  wCo*  i 
Sin  wSin  i 


-Cot  fiSin  W-Sin  fiCo*  wCot  i 
—Sin  fiSin  U-f  Cot  fiCot  LlCo*  i 
Co*  wSin  i 


+Sin  fiSin  i 
—Cot  fiSin  i 
Cot  i 


Cot  QCot  W— Sin  QSin  felCoa  i 
Sin  fiCo*  W+Cot  fiSin  uCot  i 
Sin  wSin  i 


—Cot  fiSin  W— Sin  fiCot  «Cot  i 
—Sin  fiSin  W+Cot  fiCot  wCo*  i 
Cot  WSin  i 


+Sin  fiSin  i 
—Co*  fiSin  i 
Cot  i 


pqw 
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GIBBS(  rl,r2,r3,  v2, Theta  ) 

This  procedure  perform*  the  Gibb*  method  of  orbit  determination.  Thi*  method  determines  the  velocity  at  the  middle  point  of 
the  3  given  position  vectors.  The  Gibb*  method  i*  best  *uited  for  coplanar,  *eouential  position  vector*  which  are  more  than  10 
deg  apart.  Notice  the  angle  between  the  vector*  i*  pa**ed  back  *o  the  u*er  may  make  a  decision  about  the  accuracy  of  the 
calculation*  a*  vectors  which  are  120  deg  apart  may  be  accurate,  while  vector*  8  deg  apart  may  not.  The  method  will  calculate 
the  resulting  velocity  using  the  vector*  IN  THE  ORDER  GIVEN. 


Input* 

:R1 

Variable 

-  ?!  IJK  Position  vector  #1 

Range 

DU 

R2 

-  ?2  IJK  Position  vector  #2 

DU 

R3 

-  ?3  IJK  Position  vector  #3 

DU 

Outputs 

:V2 

-  v2  Velocity  Vector  for  R2 

DU  /TU 

Theta 

-  Angle  between  the  vector* 

rad 

Local* 

:  p,q,w,d,n,S|bMi*c  Vectors 

Reference*  : 

BMW 

Escobal 

pg.  109-118  Diagram  pg.  109 
pg.  308-307 

P  =  r,  x  r3 
Q  =  f3  x 
W  =  rx  x  r2 

Check  that  the  vectors  are  Coplanar.  Fis  1  tofj  and  f3,  so  P  •  tx  must  equal  0  for  the  vectors  to  be 
Coplanar. 

D  =  P  +  <5  +  W 


N  =  r^  +  r2Q  +  r3W 

Check  that  the  orbit  is  possible.  D  and  N  must  be  non-zero,  i.e.  the  vectors  are  not  Colinear  and  they  must  be 
in  the  same  direction,  D  •  F  >  0.0. 
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HERRGIBBS(  rl,r2,r3,JDl,JD2,JD3,  v2, Theta  ) 

Thii  procedure  implement*  the  Herrick-Gibb*  approximation  for  orbit  determination,  and  finds  the  middle  velocity  vector  for 
the  3  given  position  vectors.  The  method  is  good  for  fast  calculations  and  small  angles,  <—  10  deg.  Notice  the  angle  between 
vectors  is  passed  back  to  allow  the  user  to  make  a  decision  about  the  accuracy  of  the  results  since  vectors  about  12  deg  apart 
may  be  accurate,  while  vectors  170  deg  apart  would  not.  The  observations  MUST  be  sequential  and  taken  on  one  revolution. 
The  Use  of  Julian  Dates  for  input  makes  it  much  easier  to  perform  calculations  where  the  sights  occur  around  midnight. 


Variable 

Range 

Input* 

:R1 

-  ?j  IJK  Position  vector  #1 

DU 

R2 

•  ?2  IJK  Position  vector  #2 

DU 

R3 

•  f  .  IJK  Position  vector  #3 

DU 

JD1 

-  Julian  Date  of  1st  sighting 

days  from  4713  B.C. 

JD2 

-  Julian  Date  of  2nd  sighting 

days  from  4713  B.C. 

JD3 

•  Julian  Date  of  3rd  sighting 

days  from  4713  B.C. 

Outputs 

:V2 

-  v2  IJK  Velocity  Vector  for  R2 

DU  /TU 

Theta 

Angle  between  the  vectors 

rad 

Locals 

angl 

-  Angle  between  rl  and  r2 

rad 

ang2 

-  Angle  between  r2  and  r3 

rad 

p,w 

-  Vectors 

References  : 

Escobal  pg.  254-256,  304-306 


P  =:  r2  X  F3 
Q  =  r3  x  ?1 


Check  that  the  vectors  are  Coplanar.  P  is  ±  to  F2  and  F3,  so  P  •  Fj  must  equal  0  for  the  vectors  to  be  Co- 
planar. 


Ang2  = 


Cos 


■‘(■A)  I 


Check  for  the  amount  of  space  between  the  vectors.  If  the  distance  is  too  great, 
the  accuracy  could  be  a  problem. 


Vo  = 


-  (t3-t2)  (- 


1 


(t2-tl)(t3-tl)  +  I2fl3  )  fl 
( (t3-t2)-(t2-tl)  )  (  (t2-tl)(t3-t2)  +  l2r^  ) 12 

+  (t2'U)  (  (t3-t2)\t3-tl)  +  1^7  )  r3 
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FINDCandS  (  Znew,  Cnew.Snew  ) 

This  procedure  calculates  the  C  and  S  functions  for  use  in  the  Universal  Variable  calculations.  NOTE  equality  is  handled  by 
the  series  expansion  terras  to  eliminate  potential  discontinuities.  The  series  i«  only  used  for  negative  values  of  Z  since  the 
truncation  results  in  rather  large  errors  as  Z  gets  larger  than  about  10.0. 


Inputs 

:ZNew 

- 

Variable 

Z  variable 

Outputs 

sCNew 

_ 

C  function  value 

'  ; 

SNew 

- 

S  function  value 

References  : 
BMW 
Kaplan 


pg.  207-210  Diagram  pg.  209 
pg.  304-305 


Keplers  Equation  -  NEWTONR  (  efM,  E0,l\Iu  ) 

This  procedure  perform*  the  Newton  Rhap»on  iteration  to  find  the  Eccentric  Anomaly  given  the  Mean  anomaly.  The  True 
Anomaly  it  also  calculated. 


Variable 

Range 

Input*  :e 

- 

Eccentricity 

0.0  -  1.0 

M 

• 

Mean  Anomaly 

0.0  -  2Pi  rad 

Output*  :E0 

-Eo 

Eccentric  Anomaly 

0.0  -  2Pi  rad 

Nu 

-  V 

True  Anomaly 

0.0  -  2Pi  rad 

Local*  £1 

-Ei 

Eccentric  Anomaly,  next  value 

rad 

Reference*  : 
BMW 


pg.  184-187,  220-222  Diagram  pg,  221 


KEPLER  ( ro,vo,t,  r,v  ) 

This  procedure  solves  Keplers  problem  for  orbit  determination  and  returns  a  future  Geocentric  Equatorial  (IJK)  position  and 
velocity  vector.  The  solution  procedure  uses  Universal  variables. 


Variable 

Range 

Inputs 

:Ro 

-*b 

IJK  Position  vector  -  initial 

DU 

Vo 

-7o 

IJK  Velocity  vector  •  initial 

DU/TU 

t 

-  t 

Length  of  time  to  propagate 

TU 

Outputs 

:R 

-  r 

IJK  Position  vector 

DU 

V 

-  V 

IJK  Velocity  vector 

DU/TU 

Locals 

P,G 

_ 

f  and  g  expressions 

FDot,GDot 

-F.G 

Derivatives  of  f  and  g  expressions 

XOld 

*  *0 

Old  Universal  Variable  X 

XNew 

•*n 

New  Universal  Variable  X 

ZNew 

•Zn 

New  value  of  x 

CNew 

-C 

C(x)  function 

SNew 

-s 

S(z)  function 

DeltaT 

-dt 

change  in  t 

TU 

TimeNew 

New  time 

TU 

A 

Semi  major  axis 

DU 

Alpha 

-  a 

Reciprocol  l/a 

SME 

-8 

Specific  Mechanical  Energy 

DU2  /  TU2 

S 

- 

Variable  for  parabolic  case 

W 

- 

Variable  for  parabolic  case 

Coupling  : 

FindCandS  Find  C  and  S  functions 


References  : 
Kaplan 
BMW 


pg.  304-308  ( Includes  first  guess  for  x  if  parabolic) 
pg.  191-199,  203-213  Diagram  pg.  195 


M 


Set  up  first  guess  as  follows  :  NOTE  since  t0  is  0.0,  t-t0  reduces  to  t 
Circle  or  Ellipse : 

x0  w  -fp  ( t-t0  )  a 

Check  if  a  =  1.0  since  this  makes  the  first  guess  too  close  to  converge. 


Cot(  2s  )  =  3^  ( t-t0  ) 

Tan3w  =  Tans 
Tan(^)  =  2  Cot(  2w  ) 

xo  K  #  [  Tan(-jr)  “  Tan(-y-)  j 


Hyperbola 


x0  «  «gn(  t-tQ  )\Bj- In 


I  LOOP 


-2/iar  (  t-t0  ) 


V  vo  +  818n(  t-t0  )  \| -cr  (  1  '  ro®  ) 


^n  ~  xq2 a 


If  zn  <  0.0 


o  _  1  K  .  V  V“  , 
c-i!_Tr  +  Tr‘"8r  + 

If  Zn  >  0.0 

_  1  -  Cos(  JTn  ) 


o  _  1  Zn  .  Zn 

S  ~  IT  5f  +  T 


,[2;-Sin(^) 


xo3S+  A-^x02C  +  r0x0(l-ZnS) 


x0(l-ZnS)  +  r0(i-ZnC) 


Check  if  elliptical  orbit  (  A  >  0.0  and  8  <  0.0  )  and  xn  >  2jr>fa.  If  so,  change  dt  so  the  iteration 
oesn’t  converge  as  quickly.  A  value  of  (10.0)dt  in  the  preceding  equation  seems  to  work. 


xo  ~  xn 


UNTIL  |t-tn|  <  0.00001 


=  1-49-C 
ro 


=  i-4c 


r  =  f  f0  +  g  v0 


v  =  f  r0  +  g  ?0 


g  =  t-  -2fS 


f  =  -T^xo(ZnS-l) 


GAUSS  ( rl5r2,dm,time,  vlrv2  ) 


This  procedure  solves  the  Gauss  problem  of  orbit  determination  and  returns  the  velocity  vectors  at  each  of  two  given  position 
vectors.  The  solution  uses  Universal  Variables  for  calculation  and  a  bisection  technique  for  updating  Z.  This  method  is  slower 
than  the  Newton  iteration  discussed  in  BMW,  but  it  docs  NOT  suffer  problems  with  negative  z  values,  and  is  valid  for  ellipses 
LESS  THAN  one  revolution,  parabolas,  and  Hyperbolas.  Also  note  the  selection  of  small  since  the  algorithm  is  very  sensitive  to 
changes  in  this  variable.  A  value  of  0.001  will  converge  in  say  10  iterations  instead  of  25  iterations  with  a  value  of  0.00001,  and 
the  accuracy  will  differ  in  the  3rd-4th  decimal  place.  I  chose  to  keep  the  higher  accuracy  for  cases  like  the  example,  BMW  pg. 
274,  #5.10. 

(  Refer  to  graph  on  BMW  pg.  235  for  ranges  of  z.  ) 


Variable 

Range 

Inputs  :  Rl 

-  T-nt  IJK  Position  vector  of  interceptor 

DU 

R2 

•  r^jj  IJK  Position  vector  of  target  after  time 

DU 

DM 

direction  of  motion 

’L’.’S’ 

Time 

-  tg  Time  between  Rl  and  R2 

TU 

OutPuts  :  VI 

'  VjiroJJK  Velocity  vector  of  transfer  orbit 

DU/TU 

V2 

-  v^jrafJJK  Velocity  vector  of  transfer  orbit 

DU/TU 

Local  Variables  : 

VarA 

Variable  of  the  iteration,  NOT  the  semi  major  axis! 

Y 

-  y 

F.G 

-  f,g  f  and  g  expressions 

GDot 

-  g  Derivative  of  g  expression 

XOld 

-  Xq  Universal  Variable  X 

ZOld 

-  Zq  New  value  of  z 

ZNew 

-  Zn  New  value  of  z 

CNew 

-  C  C(z)  function 

SNew 

-  S  S(z)  function 

TimeNew 

-  t  New  time 

TU 

References  : 

BMW 

pg.  228-241  (Uses  a  Newton  iteration)  Diagram  pg.  235 
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GAUSS  ( 7 j,r  2'dm,t0,  v  j,v  2  ) 

Cos  Ai/= 

dm  =  v  (Short  Way)  or  -  (Long  Way) 


VarA  =  dm.Jr1r2  (  1  +  Coe(  A  v  )  )  If  VarA  =  0.0,  the  orbit  is  not  possible 
Guess  Z0  =  0.0,  therefore  C  =  ^  and  S  =  ^ 

Set  bounds:  Upper  =  4jt2  and  Lower  =  -4* 

LOOP: 

VarA(  1  Z0S  ) 
yn  =  ri  +  r2 - 1c  — 

Check  if  VarA  >  0.0  and  y  <;  0.0,  then  re- adjust  lower  bound  of  Z  until  y  >  0.0 


x„  = 


,yn 

N^J 


x03S  +  VarA,Jy^ 

IF  t  <  t0  reset  lower  bound  =  Z0 
else 

IF  t  >  t0  reset  upper  bound  =  Z0 

upper  +  lower 

5 


Zn  = 


Calculate  C  and  S: 


If  Zn  <  0.0 


C  as 


i  »»  i 

"2l - 4f  + 


6! 


8! 


If  Zn  >  0.0 


c  = 


l-Coe(^) 

"  - Tn - 


Zo  =  Zn 


Check  if  the  first  guess  is  too  close 
UNTIL  |  t-t0  |  <  0.00001 
Evaluate  f  and  g  coefficients 


f  =  1  - 


yn 


v  _  f2"fFl 
v»  “  - 1 - 


8  =  1-4? 


v  -  «  ^  ~  rl 

V2  -  g 


Zn  Zr 
H  ~  “5T  + 


o  _  1  "n  L  “n 

o  —  -rrr  —  —  - 


S  = 


4^ii  ‘  ^*n(  4^n  ) 


g  =  VarA  ^  ^ 
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IJKtoLATLON  (  R,JD,  Latgc, Lon  ) 

This  procedure  converts  a  Geocentric  Equatorial  (IJK)  position  vector  into  latitude  and  longitude.  Geodetic  and  Geocentric 
latitude  are'found. 


Locals 


Constants 

Coupling  : 
GSTime 


Variable 

Range 

:R 

-  r 

IJK  Position  Vector 

DU 

JD 

- 

Julian  Date 

days  from  4713  B.C. 

:GeoCnLat  - 

Geocentric  Latitude 

-JT/2  to  X/2  rad 

Lon 

■ 

Longitude  (WEST  -) 

-27T  to  2X  rad 

Rc 

. 

Range  of  site  w.r.t.  earth  center 

DU 

Height 

- 

Height  above  earth  w.r.t.  site 

DU 

Alpha 

-  a 

Angle  from  I  axis  to  point,  LST 

rad 

DeltaLat 

-  A  LatDiff  between  Delta  and  Geocentric  lat 

rad 

GeoDtLat 

-  Lat  j  Geodetic  Latitude 

rad 

Delta 

■  6 

Declination  angle  of  R1  in  IJK  system 

rad 

AE 

■*e 

Equatorial  radius  of  Earth 

DU 

GST- 

Greenwich  Sidereal  Time 

rad 

Flat 

-f 

Flatenning  of  the  Earth 

0.003352810664747352 

Greenwich  Sidereal  Time 


References  : 
Escobal 


pg.  398*399 


r  =  ^  rj  +  r/  +  r^2 
a  =  Tan  "^  (  ) 


Use  procedure  GSTime  to  Find  GST 
Long  —  a  —  GST 


6  =  Tan  (  -t-JL 

\  2  ,  * 
Njri  +  rj 


Let  Latgc  =  6 


LOOP 


Rc  = 


1  -  (2f  -  f2  ) 


e^l-(2f-f2)Cos2(  Latgc  ) 
Latgd  =  Tan  -1  (  ^  Tan(  Latgc  )  ) 


Height  =  r2  -  Rc2Sin2(  Latg(J-  Latgc  )  -  RcCos(  Latg(j-  Latgc  ) 
AUt  =  Sin^  Sin  (Utgd- Utgc  )  ) 

Latgc  =  5  —  A  Lat 
UNTIL  AUt^j- AUtn  <  0.00001 
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RNGAZ  (  Llat,  Lion, Tlat, Tlon, TOF,  Range, Az  ) 

Thi*  procedure  calculate*  the  Range  and  Azimuth  between  two  specified  ground  point*.  Notice  the  range  will  ALWAYS  be 
within  the  range  of  values  listed  since  you  do  not  know  the  direction  of  firing,  long  or  short.  The  procedure  will  calculate 
Rotating  Earth  ranges  if  the  TOP  is  passed  in. 


Inputs 

LLat 

. 

Start  Geocentric  Latitude 

-X/2  -  X/2  rad 

LLon 

- 

Start  Longitude  (WEST  -) 

0.0  -  27T  rad 

TUt 

- 

End  Geocentric  Latitude 

-jr/2  -  X/2  rad 

TLon 

- 

End  Longitude  (WEST  -) 

0.0  -  21 r  rad 

TOF 

- 

Time  of  Flight  if  ICBM,  0.0  otherwise 

TU 

Outputs 

Range 

-A 

Range  between  points 

0.0-  X  rad 

A* 

- P 

Azimuth 

0.0  -  2X  rad 

Constants 

. 

OmegaEarthb>0 

Angluar  Rotation  of  the  Earth 

0.058833590688786  rad/TU 

Reference*  : 

BMW  pg.  309-3U 


A  =  Cos’1  (  Sin(  Llat  )  Sin(  TLat  )  +  Cos(  Llat )  Co*(  Tlat  )  Cos(  Tlon-Llon  +WoT0F  )  ) 
Check  for  singular  values  of  Range,  0.0  or  half  the  distance  around  the  Earth 

„  „  .j  /  Sin(  Tlat )  -  Co«(  A  )  Sin(  Tlat )  \ 

/?=  008  \ - Sin(  A  yc^TiStl - ' 

Check  if  the  Azimuth  is  greater  than  180  degrees  by 
IF  Sin(  Tlon  -Lion  +  w0TOF  )  <  0.0  THEN 
p-  2x  -  0 
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PATH  (  Hat, Lion, Range, Az,  Tlat.Tlon  ) 

This  procedure  determines  the  end  position  for  s  given  range  and  azimuth  from  a  given  point.  Notice  the  use  of  ATAN2  to 
eliminate  quadrant  problems.  Also,  Geocentric  coordinates  are  used  since  the  Earth  is  assumed  to  be  spherical. 


Inputs  : 


LLat 

- 

Start  Geocentric  Latitude 

-ff/2  -  ff/2  rad 

LLon 

- 

Start  Longitude 

0.0  -  27T  rad 

Range 

-A 

Range  between  points 

DU 

Az 

■0 

Azimuth 

0.0  -  2  JT  rad 

Outputs  : 

TUt 

- 

End  Geocentric  Latitude 

-7T/2  -  1T/2  rad 

TLon 

- 

End  Longitude 

0.0  -  27T  rad 

Locals  : 

DeltaN 

•  AN  Angle  bteween  the  two  points 

rad 

Coupling  : 

Atan2 

Arc  Tangent  function  which  also  resolves  quadrants 

References  : 

BMW  pg.  300-311 


Make  sure  Azimuth,  Lion,  and  Range  are  within  first  quadrant  constraints 


Tlat  ss  Sin'1^  Sin(  Llat )  Cos(  A  )  +  Cos(  Llat )  Sin(  A  )  Cos(  0  )  ) 

A  x,  _  A  ^  A  XIO/  Sin(  Az  )  Sin(  A  )  Cos(  A  )  -  Sin(  Tlat )  Sin(  Llat )  \ 
A  Cos(Tlat)  ’  Cos(  Tlat )  Coe(  Llat )  ) 

Tlon  =  Lion  +  AN 
Check  quadrants  of  Tlon 
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TRAJEC  (  Llat.Llon.Tlat.Tlon.Rbo.Q.TypePhi, 

RangefPhi(TOF,Az,ICPhitICVbo,ICRbo,Vn  ) 

This  procedure  calculates  the  Range,  Azimuth,  and  Time  of  Flight  between  two  specified  ground  points  for  an  ICBM  with  as 
known  Q.  Calculations  depend  on  knowledge  of  burnout  conditions,  and  the  iterations  are  performed  for  either  a  high  or  low 
trajectory.  Notice  the  ICBM  will  fly  on  an  inertial  trajectory,  and  values  for  earth  relative  velocities,  etc.,  are  calculated  after 
the  iteration.  Notice  these  calculations  do  not  support  trajectories  over  half  the  world  away. 


Inputs 

:LLat 

Start  Geocentric  Latitude 

-JT/2  -  jr/2  rad 

LLon 

Start  Longitude  (WEST  •) 

0.0  -  27T  rad 

TLat 

End  Geocentric  Latitude 

-1T/2  -  *  rad 

TLon 

End  Longitude  (WEST  -) 

0.0  -  2*  rad 

Rbo 

Radius  at  burnout 

DU 

Q 

Non-dimensional  Q  performance  based  on 

Inertial  Velocity 

TypePhi 

Type  of  trajectory,  High  ot  Low 

’H\  *L’ 

Outputs 

:  Range 

-A 

Rotating  Range  between  points 

0.0  -  t  rad 

Phi 

Inert  Flight  Path  Angle 

rad 

TOF 

Rotating  Earth  Time  of  Fligth 

TU 

Ax 

■0 

Inert  Azimuth 

0.0  -  2 T  rad 

ICPhi 

Influence  Coefficient  for  Phi 

rad/rad 

ICVbo 

Influence  Coefficient  for  Vbo 

rad/  DU/TU 

ICRbo 

Influence  Coefficient  for  Rbo 

rad/rad 

Vn 

Velocity  the  missile  needs  to  provide 

DU/TU 

Locals 

QBoMin 

Minimum  Q  for  a  given  range 

a 

Semi  Major  Axis 

DU 

Ecc 

-  e 

Eccentricity 

E 

-E 

Eccentric  Anomaly 

rad 

RangeOld 

Iteration  value  of  range 

DU 

Vbo 

Inertial  Velocity 

DU/TU 

VEarth 

Earths  velocity 

DU/TU 

Constants 

• 

OmegaEarthWc 

Angluar  Rotation  of  the  Earth 

0.058833590688786  rad/TU 

Coupling  : 

RngAz  Finds  range  and  Azimuth  given  two  points 

References  : 

BMW  pg.  283-313 
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Find  Range  and  Azimuth  wing  RNGAZ  A,  /? 


*-  Ibo 

S-  2^5 

Qbomin: 


2Sin(  y ) 

1  +  Sin(  y ) 


IF  The  ICBM  trajectory  ia  poaaible  (  >  Qj^mln  ) 

LOOP 

IF  High  Trajectory: 

—  0.5  —  Sin'*(  — )  Sin(  y  )  ~  y  ^ 

IF  Low  Trajectory 

(f>=  0.5  ^  Sin'l(  )  Sin(  y  )  —  y  ) 


e  —  >  1  +  Q  (  Q-2  )  Co*^(  ^  ) 


.  e  -  Coa(  y  ) 

B  =  Coa"*( - 3_) 

1  -  eCo«(  y  ) 

TOF  =  2^(*.E  +  e  Sin(  B  ) ) 

Find  Range  and  Azimuth  wing  new  TOF  A,  /? 
UNTIL  (  RangeOld  -  A  )  >  Small 


v  _  Q 

Vbo-\  ^ 


Evaluate  Influence  Coefficient* 


ICv 


ICr  = 


8/t  Si"2(  y ) 

"  vVbo  S!n(  ^  > 

A  H  SinVy) 


Vbo  Sin(  2<t> } 


IC*  =  2Si"(A  +  2^  -  2 
Sin(  2 <f> ) 


Vearth  =  woCo*(  LUt  ) 


Vn  = 


~vboCos(  *  )  Coj(  P  ) 
V^Coaf  4> )  Sin(  /?  ) 


VboSinf  4> ) 
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J2DRAGPERT  ( lnc,E,N,NDot,  OmegaDot,ArgpDot,EDot ) 

This  procedure  calculates  the  perturbations  for  the  predict  problem  involving  secular  rates  of  change  resulting  from  J2  and 
Drag  only. 


Inputs 

:Inc  -  i 

Inclination 

r*d 

e 

Eccentricity 

N 

Mean  Motion 

r*d/TU 

NDot  -  n 

Mean  Motion  rate 

rad  /  2TU2 

Outputs 

:OmegaDot 

Long  of  A  sc  Node  rate 

rad/TU 

ArgpDot 

Argument  of  perigee  rate 

rad/TU 

EDot 

Eccentricity  rate 

/TU 

Locals 

V 

Semi-parameter 

DU 

a 

Semi-major  axis 

DU 

Constants 

J2  -  J2 

J2  harmonic  of  the  Earth 

0.00108263 

References  : 

Escobal  pg.  369 

O'Keefe  et  al.,  Astronomical  J,  Vol  64  num  7,  pg.  247  for  Edot 


J2  -  First  order  equations  where  n  =  2 


M  s  M0  +  n(t  —  t0) 

Drag  -  Simplified  by  assun  radius  of  perigee  is  constant  as  drag  reduces  semi  major  axis  a,  therfore,  proceed  as: 
rp  =  a  (  1  -  e  ) 

Arp  =  Aa(l-e)-aAe«0 


2  (1  ~  *)  n0 

3n 


(»  -  »o> 


2  (1  -  e)  n0 

3n 
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This  procedure  determines  the  azimuth  and  elevation  for  the  viewing  of  a  staellite  from  a  known  ground  site.  Notice  the  Julian 
Date  is  left  in  it’s  usual  DAYS  format  since  the  dot  term*  are  input  as  radians  per  day,  thus  no  extra  need  for  conversion.  The 
Julian  Date  also  facilitates  finding  the  site  position  vector.  Also  observe  RANDV  is  not  used  since  this  would  merely  accomplish 
extra  calculations.  The  iteration  is  left  out  to  allow  the  user  to  set  up  his  own  loop  to  look  for  possible  sighting  times. 


Inputs 

:  JD 

Julian  Date  of  desired  observation 

Days 

JDEpoch 

Julian  date  of  epoch  for  satellite 

Days 

No 

-no 

Epoch  Mean  motion 

rad/day 

Ndot 

-Ao 

Epcoh  Half  Mean  Motion  Rate 

rad/2day2 

Eo 

-eo 

Epoch  Eccentricity 

Edot 

-«o 

Epoch  Eccentricity  rate 

/day 

Inco 

•'o 

Epoch  Inclination 

rad 

Omegao 

*  9o 

Epoch  Lon  of  Ate  node 

rad 

OmegaDot 

•«o 

Epoch  Lon  of  Ate  Node  rate 

rad/day 

Argpo 

*wo 

Epoch  Argument  of  perigee 

rad 

ArgpDot 

-*o 

Epoch  Argument  of  perigee  rate 

rad/day 

Mo 

*  Mo 

Epoch  Mean  Anomaly 

rad 

Lat 

Geodetic  Latitude  of  site 

rad 

Lon 

Longitude  of  site 

rad 

Alt 

Altitude  of  site 

DU 

Outputs 

:Rho 

•P 

Range  from  site  to  satellite 

DU 

A* 

■P 

Azimuth 

rad 

El 

Elevation 

rad 

Vis 

Visibility  Radar  Sun, 

Eye,  Radar  Nite,  Not  Visible 

Locals 

:Variable  o 

denotes  the  epoch  value,  while  no  o  it  current 

Dt 

Change  in  time  from  Epoch  to  desired  t 

days 

A 

Semi  msjor  axis 

DU 

EO 

Eccentric  Anomaly 

rad 

Nu 

•  V 

True  Anomaly 

rad 

LST 

Local  Sidereal  Time 

rad 

GST 

Greenwich  Sidereal  Time 

rad 

Theta 

Angle  between  IJK  Sun  and  Satellite  vec 

rad 

Dist 

Ppdculr  distance  of  satellite  from  RSun 

DU 

R 

IJK  Satellite  vector 

DU 

RS 

IJK  Site  Vector 

DU 

VS 

Site  Velocity  vector 

DU/TU 

RhoVec 

Site  to  satellite  vector  in  SEZ 

DU 

RHoV 

Site  to  satellite  vector  in  IJK 

DU 

RSun 

Sun  vector 

AU 

Coupling 

: 

SUN 

Position  vector  of  Sun 

SITE 

Site  Vector 

LSTime 

Local  Sidereal  Time 

NewtonR 

Iterate  to  find  Eccentric  Anomaly 

References 

: 

Escobal 

pg.  369 
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I 


Dt  —  JD  -  JDepoch 

Update  orbital  element*  from  epoch  to  current  time,  JD 


e  =  e.  +  i  At 
o  o 


q  =  +  n0  At 

w  ss  u0  +  wc  At 

n  =  n„+  n„  At 

°  °  , 
M  ”  M  +  n  A  t  +  -r  Ar 


NOTICE!!  The  NORAD  2-card  element  *et  has  nQ  sent  as  ~ 


Use  NEWTONR  to  Find  Eccentric  Anomaly  and  True  Anomaly  E  and  V,  Then  find  position  vector 
a=n2/3 

p  Co*(  V  ) 


pqw 


1  +  eCo<(  V  ) 
p  Sin(  V  ) 

1  +  eCo*(  V  ) 

0 


Cos  fiCos  u— Sin  QSin  wCo*  i  —Co*  flSin  Of— Sin  flCos  WCo*  i 

Sin  QCo*  W-f  Cos  flSin  uCoa  i  —Sin  fiSin  W+Co*  QCo*  wCo*  i 

Sin  wSin  i  Co*  wSin  i 

Ute  LSTIME  and  SITE  to  find  the  LST  and  the  Site  Vector  RSjjk 
^ijk  =  fijk  ‘  ^ijk 

Find  Topocentric  Right  asceniion  and  Declination 

m,“  =  AT“4  n^f-rr) 

y\Pi  +  Pi  \J/>i  +  Pi  P 

Decl  =  Sin'1  (y-'j 


P%tfL  “ 


Sin(lat)Co*(l*t)  Sin(lat)Sin(l*t)  -Co*(lat) 

-Sin(lst)  Co*(lst)  0 

Co*(lat)Co*(l*t)  Co*(lat)Sin{l*t)  Sin(lat) 


+ Sin  QSin  i 
—Co*  QSin  i 
Co*  i 


P>iV 


R 


pqw 


Check  Visibility 
IF  Above  the  Horizon 

7W*1  > «-° 

IF  Night  Time  at  the  site 

R§ijk  •  RSunyjj  <  0.0 


IF  Satellite  not  in  Earth’s  shadow 

Find  angle  6  between  R  and  RSun 
Dist  =  R  Cos(  9  —  90’ ) 

If  Dist  >  1.0  (  DU’s  ),  satellite  is  visible  to  the  eye 


Find  Topocentric  Azimuth  and  Elevation 


Az  =  ATan2 


~P» 


) 


29 


RENDEZVOUS  (  Rcsl,Rcs2,Phasel,NumRevs,  PhaseF.Waitime  ) 

This  procedure  calculate*  the  parameter*  for  a  Hohmann  transfer  type  rendezvous. 


Inputs 

:Rcsl  rj- 

Radius  of  circular  interceptor 

DU 

Rcs2  r2- 

Radius  of  circular  target 

DU 

Phasel  -  <t>{ 

Initial  Phase  angle 

rad 

NumRevs 

Number  of  revs  to  wait 

Outputs 

:Pha*eF  -  <f>j 

Final  Phase  Angle 

rad 

WaitTime 

Wait  time  until  next  opportunity 

TU 

Locals 

LeadAng  -  a 

Lead  Angle 

rad 

A  ■  aj 

Semi-major  axis 

DU 

Constant* 


Reference*  : 


For  the  Transfer  orbit  : 

...  rl  +  r2 

"2 - 5 — 

Time  of  flight  for  a  Hohmann  transfer  is  half  the  period  of  the  transfer  orbit  : 


TOF= 

From  the  formula  for  circular  satellite  speed  : 


v«nt  = 


a=  VtfltTOF 


4>}  = 


r  —  a 


4>i~  +  2*  NumRevs 


Wait  — 


ao 


m|“T3 


Hohmann  (  Rl,R3,el,e3,Nul,Nu3,  DeltaVl,DeltaV2,TOF  ) 

Thi>  procedure  calculates  the  delta  v’s  for  a  Hohmann  transfer  for  either  circle  to  drlce,  or  ellipse  to  ellipse.  The  notation  used 
is  from  the  initial  orbit  (1)  at  point  a,  trasnfer  is  made  to  the  trasnfer  orbit  (2),  and  to  the  final  orbit  (3)  at  point  b. 


Inputs 

:R1 

Initial  position  magnitude 

DU 

R3 

Initial  position  magnitude 

DU 

el 

Eccentricity  of  orbit  1 

e3 

Eccentricity  of  orbit  3 

Nul 

True  Anomaly  of  orbit  1 

rad 

Nu3 

True  Anomaly  of  orbit  3 

rad 

Outputs 

tDeltaVa 

Change  of  velocity  at  a 

DU/TU 

DeltaVb 

Change  of  velocity  at  b 

DU  /TU 

TOF 

Time  of  transfer 

TU 

Locals 

:Vla 

'  vla 

velocity  at  a 

DU/TU 

V2a 

*  v2a 

velocity  at  a 

DU/TU 

V2b 

"  v2fc 

velocity  at  b 

DU/TU 

V3b 

*  v36 

velocity  at  b 

DU/TU 

A 

"  *2 

Semi-major  axis 

DU 

References  : 


From  the  formula  for  circular  satellite  speed  : 


v3>,  “  nJfS 

For  the  Transfer  orbit  : 

.  _  rl  +  *3 

*2 - 5 — 

From  the  equation  for  elliptical  satellite  speed  : 


v2a  =  \] 


_  » 


v2b  =  \j 


2fS  «a 


Av  =  I  v2a  *"  vls  I  +  I  v3b“  v2b  I 


Time  of  flight  for  a  Hohmann  transfer  is  half  the  period  of  the  transfer  orbit  : 
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ONE  TANGENT  (  Rl,R3,el,e3,Nul,Nu2,Nu3,  DeltaVl,DeltaV2,TOF  ) 

This  procedure  calculates  the  delta  v’s  for  a  one  tangent  transfer  for  either  circle  to  cirlce,  or  ellipse  to  ellipse.  The  notation 
used  is  from  the  initial  orbit  (1)  at  point  a,  trasnfer  is  made  to  the  trasnfer  orbit  (2),  and  to  the  final  orbit  (3)  at  point  b. 


Inputs 

:R1 

Initial  position  magnitude 

DU 

R3 

Initial  position  magnitude 

DU 

el 

Eccentricity  of  orbit  1 

e3 

Eccentricity  of  orbit  3 

Nul 

True  Anomaly  of  orbit  1 

rad 

Nu2 

True  Anomaly  of  orbit  2 

rad 

Nu3 

True  Anomaly  of  orbit  3 

rad 

Outputs 

:DeltaVa 

Change  of  velocity  at  a 

DU/TU 

DeltaVb 

Change  of  velocity  at  b 

DU/TU 

TOF 

Time  of  transfer 

TU 

Locals 

:Vla 

*vlo 

velocity  at  a 

DU/TU 

V2a 

”  v2a 

velocity  at  a 

DU  /  TU 

V2b 

'  v2b 

velocity  at  b 

DU/TU 

V3b 

-v36 

velocity  at  b 

DU/TU 

A 

-*2 

Semi-major  axis 

DU 

References  ; 


Consider  the  one  tangent  bum  transfer  illustrated  to  the  right.  Before  determining  the  total  change  in  velocity,  the  transfer 
orbit  eccentricity  must  be  calculated. 


Cos  t/2b  - 


rl  =  *2  (1  -  e2) 


Prom  the  formula  for  circular  satellite  speed  : 


vla  ~  \  F\ 


-  U1 

-  Ti 


Prom  the  equation  for  elliptical  satellite  speed  : 


v2a  -  \PfT  ~ 


FT  -55 


_  I./*  _  » 

—  \  2c-  —  rr 


_  _ *1 


Ava  =  !  v2a  —  vla  I 


The  flight  path  angle  is  needed  for  the  non-tangential  transfer  at  b 
,  e0  Sin  t'oK 

Tan  <^>2b  -  j  +  ^  Co4  ^ 

Since  the  final  orbit  is  circular,  $2b  =  0.0. 

Avb  =  \|v3b  +  v2b  “  2v3bv2bCo*  (^3b  “  ^2b) 

The  total  A  v  is  simply  the  sum  of  the  two  bums. 

A  v  =  A  +  A  vb 


Time  of  flight  is  calculated  using  Keplers  Equation. 

R7 

TOF  =  ^  3  2kx  +  (E  —  e2  Sin  E)  -  (EQ  -  e2  Sin  E0) 


Since  this  transfer  is  initiated  at  periapsis,  EQ  =  0.0.  The  transfer  does  not  pass  periapsii,  so  k  must  =  zero. 


CosE  = 

1  +  e2  Cos  t/2b 
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HILLSR  (  R,V,Alt,T,  R1,V1 ) 

This  procedure  calculate*  the  various  position  information  for  Hills  equations.  Notice  the  XYZ  system  used  has  Y  colinear  with 
Target  Position  vector,  Z  normal  to  target  orbit  plane,  and  X  in' the  direction  of  velocity. 


Inputs 

:R 

- 

Initial  position  vector  of  INT 

DU 

V 

- 

Initial  velocity  vector  of  INT 

DU/TU 

Alt 

- 

Altitude  of  target  satellite 

DU 

T 

- 

Desired  Time 

TU 

Outputs 

:R1 

. 

Final  position  vector  of  INT 

DU 

VI 

- 

Final  velocity  vector  of  INT 

DU/TU 

Locals 

n 

. 

Circular  velocity  of  INT 

DU/TU 

References  : 

Kaplan  pg.  108-115 


n  =  >lr 

x(t)  =  -yf  Sin  nt  —  ^  -^+  3xq  ^  Cos  nt  +  ^  4xg  ^ 

yM  =  -n2  C08  nt  +  (  ®xo  )  Sin  nt  +  ^  y0  — ^  ^  -  ^3y0  +  6nx<)  ^  t 
2 

z(t)  =  Zq  Coe  nt  +  -^  Sin  nt 
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HILLSV  (  R.AIt.T,  V) 

This  procedure  calculates  the  initial  velocity  for  the  Hills  equations.  Notice  the  XYZ  system  used  has  Y  colincar  with  Target 
Position  vector,  Z  normal  to  target  orbit  plane,  and  X  in  the  direction  of  velocity. 


Inputs  :R 

Initial  position  vector  of  INT 

DU 

Alt 

-  Altitude  of  target  satellite 

DU 

T 

Desired  Time 

TU 

Outputs  :V 

•  Initial  velocity  vector  of  INT 

DU/TU 

Locals  a 

Circular  velocity  of  INT 

DU/TU 

References  : 

Kaplan 

pg.  108-115 

^6xq  (nt  -  Sin  nt)  -  y0J  nSin  nt  -  2nxg  (4  -  3Cos  nt)(l  -  Cos  nt) 
y°  (4Sin  nt  -  3nt)Sin  nt  +  4(1  -  Cos  nt  )* 


nxo  (4  -  3Coe  nt)  +  2(1  -  Cos  nt)  y0 
Sin  nt 
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REENTRY  (  Vre,PhiRe,BC,H,  V.Decl.MaxDed  ) 

This  procedure  calculate*  variou*  reentry  paramter*  using  the  Allen  k  Eggar*  approximation*. 


Input* 

:Vre 

-  i 

Reentry  Velocity 

m/s 

PhlRe 

- 

Reentry  Plight  Path  Angle 

rad 

BC 

- 

Ballistic  Coefficient 

kg/m2 

H 

- 

Altitude 

km 

Outputs 

:V 

. 

Velocity 

m/s 

Ded 

- 

Deceleration 

«’* 

MaxDecl 

- 

Maximum  deceleration 

g’« 

Locals 


Reference*  : 


/>0e 


—tclht  h 


v  =  Vre  e 


.  2  BC  tclht  Sin  <t>. 


$  -  tclht  Vre  Sin  <j>re 

'g  max  -  Yge 

v  a  =  vre  e--5  »  0.61  vre 
pj 2  A  tclht  Sin  <f>re 


V  —  re 

max  g 


V.  =  v„  e 
imp  re 


“^/gimp  =  rrt  e  [*/  A  *c"“  Sin  *re] 
Hmax  |  Ln  (  BC  sc/ht  Sin  <6re  ) 
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Quartic  Root  Solutions 

Ref :  Escobal  pg  430-433  Assume  the  general  form  of : 

y  =  Ax4  +  Bx3  +  Cx2  +  Dx  +  E 

Rearrange  as 

y  =  x4  +  B/x3  +  Chc2  +  Dhc  -f  E/ 


P  =  6h2  +  3B/h  +  Ci 


Q  =  4h3  +  3B/h2  +  2C/h  +  D/ 

IF  Q  =  0.0,  let  Z  =  y*'  and  solve  the  quadratic  for  Z  (  Z2  +  PZ  +  R  =  0  ) 
y  =  'IZ 
x;  =  yf  +  h 

R  =  h4  +  Bth3  +  C/h2  +  D/h  +  E/ 
a  =  i(3(P2-4R)-4P2) 
b  =  i  (  16P3  -  18P(P2  -  4R)  -  27Q2  ) 


IF  A  >  0.0  THEN 


Use  Cardan’s  Formula,  be  sure  to  evaluate  negative  cube  roots  with  SGN  function 


Zj  =  \|-{K>[a  +  3f|-fA 


<=3 

~T~ 


Root2l- 
Root3l-  =  -Root2l- 


4--fa 


IF  A  =  0.0  THEN  Make  sure  to  evaluate  the  negative  cube  roots  using  SGN  function 


IF  A  <  0.0  THEN  Use  Trigonometric  identity 


Cos  <f>  —  'j  ^  i^-  Sin  <f>  —  a|1—  Co82  <f> 

2JW 

Zj  =  E0  Cos  | 

Z2  =  E0  Cos  (|  +  120*) 


Z3  =  E0  Cos  (|  +  240') 
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Find  Rv  as  the  largest  value  of  (  Z;  +  s  ) 

H<p  +  r,+  Jr) 

Solve  the  quadratics 
y2  +  ■'Ht/y  +  < 
y2  +  >fR/y  +  /? 


The  Roots  are  then 

X;  =  y;  +  h 
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APPENDIX  A 


PASCAL  SOURCE  CODE 
TECHNICAL  ROUTINES 


} 

UNIT  AstroLibi 


(*  -  *) 

(*  *) 

(*  Module  -  ASTROX.IB.PAS  *) 

(*  *) 

(*  This  file  contains  fundamental  Astrodynamlc  procedures  and  functions  *) 

(*  relating  to  the  time  functions.  *) 

(*  *) 

(*  *****************  NOTICE  OP  GOVERNMENT  ORIGIN  ****************  *) 

(*  *) 

(*  This  software  has  been  developed  by  an  employee  of  the  United  States  *) 

(*  Government  at  the  United  States  Air  Force  Academy,  and  is  therefore  *) 

{*  a  work  of  the  United  States,  and  is  NOT  subject  to  copyright  protection  *) 

(*  under  the  provisions  of  17  U.S.C.  105.  ANT  use  of  this  work,  or  *) 

(*  inclusion  in  other  works,  must  comply  with  the  notice  provisions  of  *) 

(*  17  U.S.C.  403.  *) 

(*  *) 

|*  ****************************************************************  *  J 

(*  *) 

( *  Current  :  30  Jan  91  Capt  Dave  Vallado  VERSION  3.0  *) 

(*  *) 

(*  Changes  t  28  Jan  91  Capt  Dave  Vallado  *) 

(*  Add  algorithm  section  *) 

(*  20  Sep  90  Capt  Dave  Vallado  *) 

(*  Update  small  in  elorb/randv/angle  etc  *) 

(*  Change  to  Predict  for  rtasc  and  decl  *) 

(*  20  Apr  90  Capt  Dave  Vallado  VERSION  2.0  *) 

(*  Version  2.0  *) 

(*  16  Nov  89  Capt  Dave  Vallado  *) 

(*  Integrated  into  one  file  *) 

(*  12  Feb  89  Capt  Dave  Vallado  *) 

(*  Standardised  format  *) 

(*  28  Sep  88  Capt  Dave  Vallado  *) 

(*  Added  HMS  and  DMS  to  Rad  conversions  *) 

(*  30  Aug  88  Capt  Dave  Vallado  *) 

(*  Version  1.0  *) 

(*  *) 


} 


INTERFACE 


(* 


Uses  Math) 


*) 


TYPE 

Strll  =  STRING! 11]) 

StrlO  =  STRING! 10]) 

Str3  =  STRING! 3]) 

VAR 

Show  :  Chart 
FileOut  i  TEXT; 

{  -  Routines  lor  Time  calculations 


(  Yr,Mon,D,H,H 


Procedure  JulianDay 

Procedure  DayO£Yr2MDHMS 

Procedure  InvJulianDay 

Procedure  FindDays 

Function  GSTime 
Function  GSTlmO 
Procedure  LSTime 

Procedure  SunRiseSet 

Procedure  HMStoUT 

Procedure  UTtoHHS 

Procedure  HMStoRad 

Procedure  RadtoHMS 

Procedure  DHStoRad 

Procedure  RadtoOMS 


S 

VAR  JD 

(  Vr 
Days 

VAR  Hon,D,H,H 
VAR  S 

(  JD 

VAR  Yr,Mon,D,HiM 
VAR  S 

(  Year , Month, Day , Hr, Min 
Sac 

VAR  Days 
(  JD 
(  *r 

(  Lon, JD 
VAR  LST,GST 

(  JDate,Lat,Lon 
WhichXlnd 

VAR  UTSunRise,  UTSunSet 

(  Hr, Min 
Sac 

VAR  UT 
{  UT 

VAR  Hr, Min 
VAR  Sec 

{  Hr, Min 
8ec 

VAR  KHS 
(  HMS 

VAR  Hr, Min 
VAR  Sec 

(  Deg, Min 
Sec 

VAR  DHS 
(  DHS 

VAR  Deg, Min 
VAR  Sec 


- } 

Integer; 

Extended; 

Extended  ); 

Integer; 

Extended; 

Integer; 

Extended  ); 

Extended; 

Integer) 

Extended  )) 

INTEGER) 

Extended) 

Extended  ); 

Extended  )t  Extended) 

Integer  )t  Extended; 

Extended) 

Extended  )) 

Extended) 

CHAR) 

Extended  )) 

Integer) 

Extended) 

Extended  )) 

Extended; 

Integer; 

Extended  ); 

Integer) 

Extended; 

Extended  ); 

Extended) 

Integer) 

Extended  ); 

Integer) 

Extended) 

Extended  )) 

Extended) 

Integer) 

Extended  )) 


A-l 


) 


{ 


Routines  for  Technical  2-Body  calculations 


} 


Procedure  Site 

Procedure  RVToPOS 
Procedure  Track 

Procedure  Ra2el 

Procedure  Elorb 

Procedure  RandV 

Procedure  Gibbs 

Procedure  HerrGlbbs 

Procedure  PlndCandS 
Procedure  NewtonR 
Procedure  Kepler 

Procedure  Gauss 

Procedure  UKtoLatLon 

Procedure  Sun 

Procedure  Moon 

Procedure  PlanetRV 

Function  Geocentric 
Function  InvGeocentric 
Procedure  Sight 

Procedure  Light 

Procedure  0MS2 

( 


(  Lat,Alt,Lst 
VAR  RS.VS 

(  Rho,Az,Bl,DRhO,DAz,DEl 
VAR  Rhovec,DRhovec 

(  RhO,Az,El,DRho,DAz,DEl, 
Lat.Lst 

VAR  R,V 

(  R,V,RS 
Lat.Lst 

VAR  Rho,Az,El,DRho,DAz,DEl 
(  R»V 

VAR  P,A,Ecc,Inc,Omega,Argp 
Nu,M,U,L,CapPl 

(  P,E, Inc, Omega, Argp,Nu, 
U,L,CapPl  * 

VAR  R,v  : 

(  R1,R2,R3 
VAR  V2 
VAR  Theta 
VAR  fit 

(  R1,R2,R3 
JD1,JD2,JD3 
VAR  V2 
VAR  Theta 
VAR  fit 

(  ZNew 

VAR  CHew.SHev 

(  E,M 

VAR  SO, Mu 

(  Ro,Vo 
Time 
VAR  R,V 

(  R1,R2 
DM 
Tin# 

VAR  VI, V2 

(  R 
JD 

VAR  GeoCnLat,Lon 
(  JD 

VAR  RSun 
VAR  RtAsc.Decl 

(  JD 

VAR  RMoon 
VAR  RtAsc,Decl 

(  PlanetMum 
JD 

VAR  R,V 

(  Lat 

(  Lat 

(  R1.R2 
VAR  LOS 

(  R 
JD 

VAR  LIT 

(  Lat, Lon, Alt, Phi ,Az, Speed, 
VAR  R»V 


Extended) 
Vector  ) ; 

Extended; 
Vector  ) ; 


Extended; 
Vector; 
Vector  ) ; 

Vector; 
Extended; 
Extended  ) ; 

Vector; 

Extended  ); 


Extended; 

Vector  ) ; 

Vector; 

Vector; 

Extended; 

Integer  ) ; 

Vector; 

Extended; 

Vector; 

Extended; 

Integer  ) ; 

Extended; 

Extended  ); 

Extended; 

Extended  ); 

Vector; 

Extended; 

Vector  ); 

Vector; 

Char; 

Extended; 

Vector  ) ; 

Vector; 

Extended; 

Extended  ); 

Extended; 

Vector; 

Extended  ); 

Extended; 

Vector; 

Extended  ) ; 

Integer; 

Extended; 

Vector  ) ; 

Extended  )i  Extended; 

Extended  ):  Extended; 

Vector; 

Str3  ); 

Vector; 

Extended; 

Str3  ); 

JD  i  Extended; 
t  VECTOR  ) ; 


A-ll 


{ 


Routine*  for  icbm  calculations 


} 


Procedure  RngAz  (  LLat , LLon, TLat , TLon, TO?  t  Extended; 

VAR  Range,  As  :  Extended  ); 

Procedure  Path  (  LLat,  LLon,  Range,  As  :  Extended; 

VAR  TLat,  TLon  s  Extended  ); 

Procedure  Trajec  (  LLat, LLon, TLat, TLon, Rbo,Q  t  Extended; 

TypePhi  >  Char; 

VAR  Range,Phi,TOF,Aa,ICPhl, 

lCVbo,XCRbo  t  Extended; 

VAR  VN  ;  Vector  ); 

{  -  Routine*  for  Orbit  Transfer  calculations  -  } 

Procedure  Hohmann  (  Rl,R3,el,e3,Hul,Hu3  ;  Extended; 

VAR  Deltava,Deltavb,TOF  t  Extended  ); 

Procedure  OneTangent  (  Rl,R3,el,e3,Nul,Nu2,Nu3  t  Extended; 

VAR  Deltava,D#ltavb,TOF  t  Extended  ); 


Procedure  GeneralCoplanar  (  Rl,R3,el,e2,e3,Hul,Nu2a,Nu2b,Nu3  t  Extended; 

VAR  Deltava,Deltavb,TOF  t  Extended  ); 


Procedure  Rendezvous  (  Rc*l,Rc*2,PhaseI 

NuaRevs 

VAR  PhaseF.WaitTime 


;  Extended; 

2  Integer; 

;  Extended  ); 


Procedure  Interplanetary  (  Rl,R2,Rbo,Rinpact,Mul,Mut,Mu2  2  Extended; 

VAR  Deltavl,Deltav2,Vbo,Vretro  2  Extended  ); 


Procedure  Reentry  (  Vre,PhlRo,BC,h 

VAR  V,Decl,MaxDecl 


Extended; 
Extended  ); 


Procedure  HlllsR 


(  R,V 
Alt  ,t 
VAR  R1,V1 


2  Vector; 

2  Extended; 

1  Vector  ) ; 


(  * 

Alt  ,t 
VAR  V 


Procedure  HillsV 


2  Vector; 

2  Extended; 

;  Vector  ) ; 


Routines  for  Technical  Perturbed  calculations 


{ 


} 


{  -  and  Numerical  Integration  techniques 


} 


Procedure  Target 


RInt,VInt,RTgt,VTgt 

Dm 

TOP 

VAR  Vlt,V2t,DVl,DV2 


Vectoi ( 
CHAR) 
Extended; 
Vector  ) ; 


Procedure  PKepler 


Procedure  J2DragPert 


Procedure  Predict 


Procedure  Deriv 


(  ROiVo 
DeltaT 
VAR  R,  V 


Vector) 
Extended) 
Vector  ) ) 


(  lnc,E,N,NDot 
VAR  OmegaDOT, ArgpDOT,EDOT 


Extended ; 
Extended  ) ; 


JD , JDBpoch ,  no , Ndot , Eo ,  Edo t 
Omegao,OmegaDot,Argpo,Argpi 
Lat,Lon,Alt 

VAR  Rho,A*,El,RtASC,Decl 
VAR  Vis 


inco, 

Dot, Mo, 
Extended) 
Extended; 
Strll  ); 


(  ZTime 
X 

VAR  XDot 


Extended) 
Matrix; 
Matrix  )) 


Procedure  PertAccel 

(  R,V 

i  vector; 

IT  in# 

i  Extended) 

WhichOne 

>  Integer; 

BC 

t  Extended) 

VAR  APert 

>  Vector 

Procedure  PDeriv 

(  X 

i  Matrii ; 

ITlSM 

>  Extended; 

DerivType 

:  StrlO; 

BC 

i  Extended; 

VAR  XDot 

t  Matrix 

Procedure  RK4 

(  ITioe 

>  Extended) 

DT 

>  Extended) 

N 

t  Integer; 

DerivType 

t  StrlO) 

BC 

t  Extended; 

VAR  X 

i  Matrix 

Procedure  ATMOS 


Procedure  CHEBY 


(  R 

VAR  RhO 
(  ALT 

VAR  PALT , RHOALT 


Vector; 
Extended  ) ; 

Extended; 
Extended  ) ) 


Constants  used  in  this  Library 


Rad 

S7. 29577951308230 

Degrees  per  radian 

HalfPl 

1.57079632679490 

Pi 

3.14159265358979 

TWOPi 

6.28318530717959 

OmegaEarth 

0.0588335906868878 

Angular  rotation  of  Earth  (Rad/TU) 

RadPerDay 

6.30038809866574 

Rads  Barth  rotates  in  1  Solar  Day 

TUMln 

13.44685108204 

Minutes  per  Time  Unit 

TUDaySun 

54.20765355 

days  per  sun  TU 

EESqrd 

0.00669437999013 

Eccentricity  of  Barth's  shape  squared 

Flat 

0.003352810664747352 

Flatenning  of  the  Earth 

GMS 

332952.9364 

Sun  Gravitational  Parameter  D03/TU2 

GMM 

0.01229997 

Moon  Gravitational  Parameter  DU3/TU2 

J2 

0.00108263 

J3 

-0.00000254 

J4 

-0.00000161 

TUDay 

0.00933809102919444 

Days  per  Time  Unit 

<* 


IMPLEMENTATION 


*) 


(* 

{ 


*) 
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PROCEDURE  JULIANDAY 


This  procedure  finds  the  Julian  date  given  the  Year,  Month,  Day,  and  Time. 
The  Julian  date  is  defined  by  each  elapsed  day  since  noon,  1  Jan  4713  BC. 
Julian  dates  are  measured  from  this  epoch  at  noon  so  astronomers 
observations  may  be  performed  on  a  single  "day".  The  year  range  is 
limited  since  machine  routines  for  365  days  a  year  and  leap  years  are 
valid  in  this  range  only.  This  is  due  to  the  fact  that  leap  years  occur 
only  in  years  divisible  by  4  and  centuries  whose  number  is  evenly 
divisible  by  400.  (  1900  no,  2000  yes  ...  ) 

NOTEi  This  Algorithm  is  taken  from  the  1988  Almanac  for  Computers, 

Published  by  the  U.S.  Naval  Observatory.  The  algorithm  is  good  for  dates 
between  1  Mar  1900  to  28  Feb  2100  since  the  last  two  terms  (from  the 


Almanac) 

are  commented  out. 

Algorithm 

i  Find  the  1 

various  terms  of 

the  expansion 

Calculate 

the  answer 

Author 

i  Capt  Dave 

Vallado  USAFA/DFAS  719-472-4109 

12  Aug  1988 

Inputs 

• 

Yr 

-  Year 

1900  .. 

2100 

Mon 

-  Month 

1  .. 

12 

D 

-  Day 

1  .. 

28,29,30,31 

H 

-  Universal 

Time  Hour 

0  .. 

23 

M 

-  Universal 

Time  Min 

0  .. 

59 

Sec 

-  Universal 

Time  Sec 

0.0  .. 

59.999 

Outputs 

; 

JD 

-  Julian  Date 

days  from  4713  B.C. 

Locals 

I 

Terml 

-  Temporary 

Extended  value 

Term2 

-  Temporary 

INTEGER  value 

Term3 

-  Temporary 

INTEGER  value 

UT 

-  Universal 

Time 

days 

Constants 

i 

None. 

Coupling 

t 

None. 

References 

X 

1988  Almanac  for  Computers  pg.  B2 
Bscobal  pg.  17-19 

Kaplan  pg.  329-330 

-  } 


PROCEDURE  JullanDay  (  Yr,Mon,D,H,H  t  Integer; 

S  >  Extended; 

VAR  JD  ;  Extended  ) ; 

VAR 

Term2,  Term3  ;  INTEGER; 

Terml,  UT  i  Extended; 

BEGIN 

TERM1 i =  367.0  *  Yr; 

TERM2i=  TRUNC(  (7*  (Yr+TRUNC  (  (Mon+9)/12)  )  )  /  4  ); 

TERM3i=  TRUNC(  275*Mon  /  9  ); 

UTi 1  (  (S/60.0  +  M  )  /  60.0  +  H  )  /  24.0) 


JD;=  (TBRM1-TERH2+TERH3)  +  D  +  1721013.5  +  UT  (  +  ***}; 
END;  {  Procedure  JullanDay  } 


{ 
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|  PROCEDURE  DAYOFYR2KDHHS 

I  This  procedure  converts  the  day  of  the  year,  days,  to  the  month 
I  day,  hour,  minute  and  second. 

j  Algorithm  :  Set  up  array  for  the  number  of  days  per  month 
I  loop  through  a  temp  value  while  the  value  is  <  the  days 

i  Perform  integer  conversions  to  the  correct  day  and  month 

j  Convert  remainder  into  H  M  3  using  type  conversions 

I  Author  s  Capt  Dave  Vallado  USAFA/DFAS  719-472-4105  26  Feb  1990 


Inputs 

Yr 

t 

-  Year 

1900 

..  2100 

Days 

-  Julian  Day  of  the  year 

0.0 

..  366.0 

Outputs 

Mon 

i 

-  Month 

1 

..  12 

D 

-  Day 

1 

..  28,29, 

H 

-  Hour 

0 

..  23 

M 

-  Minute 

0 

..  59 

Sec 

-  Second 

0.0 

..  59.999 

Locals  i 

Dayofyr  -  Day  of  year 

Temp  -  Temporary  Extended  values 

IntTsmp  -  Temporary  Integer  value 

1  -  Index 

Constants  i 

LMonth[12]  -  Integer  Array  containing  the  number  of  days  per  month 

Coupling  : 

None. 

References  : 

None. 


PROCEDURE  Day0fYr2MDHHS  (  *r  i  Integer; 

Days  i  Extended; 

VAR  Non,D,H,M  i  Integer; 

VAR  S  l  Extended  ) ; 

VAR 

Temp  i  Extended; 

intTemp,  1,  DayOfYr  i  Integer; 

LMonth  i  Array [1.. 12)  of  Integer; 

BEGIN 

{  - Set  up  array  of  days  in  month  - ) 

FOR  it=  1  to  12  DO 
BEGIN 

CASE  l  OF 

1,3,5,7,8,10,12  i  LMonth! i 1 i=  31; 

4,6,9,11  i  LMonth! 1  ] :  =  30; 

2  i  LMonth! i] Is  28; 

END;  {  Case  } 

END; 

DayofYr»=  TRUNC(Days  ); 

{ - Find  month  and  Day  of  month - } 

IF  (  (Yr-1900)  HOD  4  )  *  0  THEM 
LMonth! 2] i s  79; 
i:=  1; 

IntTempis  0; 

WHILE  (  DayOfYr  >  IntTemp  +  LMonth! I J  )  and  (  1  <  12  )  DO 
BEGIN 

IntTemp: =  IntTemp  +  LMonth! i}; 

1«*  i+1; 

END; 

Honi=  i; 

D  DayOfYr  -  IntTemp; 

{ - Find  hours  minutes  and  seconds - } 

Te*pi=  (Days  -  DayofYr  )*24.0; 

H  i=  TRUNC(  Temp  ); 

Tempi =  (Temp-H  )  *  60.0; 

H  »  =  TRUNC(  Temp  )| 

S  1=  (Teap-M  )  *60.0; 

END;  {  Procedure  DayofYr2HDHHS  } 


} 

{ - 

j  PROCEDURE  INVJULIANDAY 

I  This  procedure  finds  the  Year,  month,  day,  hour,  minute  and  second 
i  given  the  Julian  date. 

I  Algorithm  :  Set  up  starting  values 

j  Find  the  elapsed  days  through  the  year  in  a  loop 

j  Call  routine  to  find  each  individual  value 


Author 

:  Capt  Dave  Vallado  USAFA/DFAS 

719-472-4109 

26  Feb  1990 

Inputs 

t 

JD 

-  Julian  Date 

days 

from  4713  B.C. 

Outputs 

t 

Yr 

-  Year 

1900 

2100 

Hon 

-  Month 

1 

12 

D 

-  Day 

1 

28,29,30,31 

H 

-  Hour 

0 

23 

M 

-  Hinute 

0 

59 

Sec 

-  Second 

0.0 

59.999 

Locals 

t 

days 

-  Day  of  year  plus  fraction  of  a 

day  days 

Tu 

-  Julian  Centuries  from  1  Jan  1900 

Temp 

-  Temporary  real  values 

LeapYrs 

-  Number  of  Leap  years  from  1900 

| 

Constants 

t 

None. 

Coupling 

S 

DayofYr2MD 

Finds  Month,  day,  hour,  minuta 

and  second 

given  Days  and 

References 

i 

1988  Almanac  for  Computers  pg.  B2 

Escobal 

pg.  17-19 

Kaplan 

pg.  329-330 

} 


PROCEDURE  INVJULIANDAY  (  JD  I  Extended) 

VAR  Yr,Mon,D,H,M  t  Integer; 

VAR  8  >  Extended  ); 

VAR 

Days,  Tu,  Temp  i  Extended) 

LeapYrs  t  Integer; 

BEGIN 

{ - Find  Year  and  Days  of  the  year - — - } 

Temp i =  JD-2415019.5; 

Tu  :=  Temp  /  365.25; 

Yr  i=  1900  +  TRUNC (  Tu  ); 

LeapYrs i =  TRUNC<  (  Yr-1900-1  )/4.0  ); 

Daysi=  Temp  -  ( (Yr-1900)*3S5.0  +  LeapYrs  ); 

{ - Check  for  case  of  beginning  of  a  year - } 

IF  Days  <1.0  THEN 
BEGIN 

Yr  i  =  Yr  -  1; 

LeapYrs  ;  =  TRUNC (  (  Yr-1900-1  J/4.0  ); 

Daysi=  Temp  -  ( (Yr-1900)*365.0  +  LeapYrs  ); 

END; 


{ - Find  remaing  data  - } 

DayO£Yr2MDHMS(  Yr.Days,  Hon,D,H,M,S  ); 

END;  {  Procedure  Inverse  mod  jd  } 


A-3 


} 

{ - 

I  PROCEDURE  FINDDAYS 

j  This  procedure  finds  the  fractional  days  through  a  year  given  the  year, 
I  month,  day,  hour,  minute  and  second. 

1  Algorithm  :  Set  up  array  for  the  number  of  days  per  month 
I  Check  for  a  leap  year 

I  Loop  to  find  the  elapsed  days  in  the  year 


Author 

Inputs 

:  Capt  Dave  Vallado  USAFA/DFAS 

t 

719-472-4109 

11  Dec 

Yr 

-  Year 

1900  .. 

2100 

Mon 

-  Month 

1  .. 

12 

D 

-  Day 

1  .. 

28,29,: 

H 

-  Hour 

0  .. 

23 

M 

-  Minute 

0  .. 

59 

Sec 

-  Second 

0.0  .. 

59.999 

Outputs  : 

days  -  Day  of  year  plus  fraction  of  a  day  days 

Locals  i 

1  -  index 

Constants  i 

Hone. 

Coupling  i 

Hone. 

References  : 

None. 


PROCEDURE  FindDays  (  Year, Month, Day, Hr, Min  ;  INTEGER) 

Sec  i  Extended; 

VAR  Days  t  Extended  ); 

VAR 

1  <  BYTE; 

L Month  I  ARRAY! 1. .12]  of  INTEGER; 

BEGIN 

FOR  li=  1  to  12  DO 
BEGIN 

CASE  i  OF 

1,3,5,7,8,10,12  ;  LHonth[i];=  31; 

4,6,9,11  t  LMonth! 1 ] ;*  30; 

2  ;  LKonth[i]i=  28; 

END;  {  Case  } 

END; 

IF  TRUNC(  RealHOD(  Year-1900,4  )  )  -  0  THEN 
LMonth! 2 );=  29; 
l  ;=  1; 

Days : =  0.0; 

WHILE  (1  <  Month)  and  (  i  <  12  )  DO 
BEGIN 

Days ; =  Days  +  LMonth! 1]; 
li  =  i  +  1; 

END; 

Dayst=  Days  +  Day  +  Hr/24.0  +  Hln/1440.0  +  Sec/86400.0; 

END;  {  Procedure  FindDays  } 


A-4 


} 

{ - 

I 

j  FUNCTION  GSTINE 

I 

I  This  function  finds  the  Greenwich  Sidereal  time.  Notice  just  the  integer 
j  part  of  the  Julian  Date  is  used  for  the  Julian  centuries  calculation. 

1  Algorithm  i  Perform  expansion  calculation  to  obtain  the  answer 
j  Check  the  answer  for  the  correct  quadrant  and  size 

I 

|  Author  »  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  12  Feb  1989 

I 

I  Inputs  : 

j  JD  -  Julian  Date  days  from  4713  B.C. 

I 

|  Outputs  I 

I  GSTime  -  Greenwich  Sidereal  Time  0  to  2P1  rad 

I 

I  Locals  ; 

j  Temp  -  Temporary  variable  for  reals  rad 

j  Tu  -  Julian  Centuries  from  1  Jan  2000 

I 

I  Constants  : 

j  TwoPL 

j  RadPerDay  -  Rads  Earth  rotates  in  1  Solar  Day 
I  Coupling  i 

I  RealMOD  Real  MOD  function 

I 

I  References  i 

I  1989  Astronomical  Almanac  pg.  B6 

I  Escobal  pg.  18  -  21 

I  Explanatory  Supplement  pg.  73-75 
I  Kaplan  pg.  330-332 

I  BMW  pg.  103-104 

I 

- } 

FUNCTION  GSTime  (  JD  t  Extended  )t  Extended) 

CONST 

TwoPl  i  Extended  *  6.28318530717959) 

RadPerDay)  Extended  &  6.3003(809866574) 

VAR 

Tempi  Tu  t  Extended) 

BEGIN 

TU  :=  (  INT(JD)  +  0.5  -  2451545.0  )  /  36525.0) 

Tempi =  1.753368559  +  628.3319705*Tu  +  6.770708127E-06*Tu*TU  + 

RadPerDay* (  (FRAC(  JD  )-0.5)  )i 

{  -  Check  quadrants  -  } 

Tempi =  RealM0D(  Temp, TwoPl  )) 

IF  Temp  <0.0  THEN 

Temp i *  Temp  +  TwoPl) 

GSTime i-  Temp) 

END)  (  Function  GSTime  } 
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FUNCTION  GSTIMO 


This  function  finds  the  Greenwich  Sidereal  time  at  the  beginning  of  a  year. 
This  formula  is  derived  from  the  Astronomical  Almanac  and  is  good  only  for 
0  hr  UT,  1  Jan  of  a  year. 


Algorithm 

Author 

Inputs 

Yr 

Outputs 

GSTimO 


:  Find  the  Julian  Date  Ref  4713  BC 
Perform  expansion  calculation  to  obtain  the  answer 
Check  the  answer  for  the  correct  quadrant  and  size 

:  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Feb  1989 

-  Year  1988,  1989,  etc. 


-  Greenwich  Sidereal  Time  0  to  2Pi  rad 


Locals 

JD 

Temp 

Tu 


-  Julian  Date  days  from  4713  B.C. 

-  Temporary  variable  for  Reals  rad 

-  Julian  Centuries  from  1  Jan  2000 


Constants 

TwoPi 


Two  times  Fi 


Coupling 

RealHOD 


Real  NOD  function 


References  i 

1989  Astronomical  Almanac  pg.  B6 

Escobal  pg.  18  -  21 

Explanatory  Supplement  pg,  73-75 
Kaplan  pg.  330-332 

BMW  pg.  103-104 


} 


FUNCTION  GSTimO  (  Yr  i  Integer  )«  Extended) 

CONST 

TwoPi  i  Extended  *  6.28318530717959) 

VAR 

JD,  Temp,  Tu  i  Extended) 

BEGIN 

JD  !=  367.0  *  Yr  -  (  TRUNC( (7*(Yr+TRUNC{10/12) ) )/4)  )  + 

(  TRUNC( 275/9)  )  +  1721014.5) 

Tu  :=  (  INT(JD)  +  0.5  -  2451545.0  )  /  36525.0) 

Temp:=  1.753368559  +  628.3319705*TU  +  6.770708127B-06*Tu*Tu) 

{  -  Check  quadrants  -  } 

Temp:=  RealMODf  Temp, TwoPi  )) 

IF  Temp  <0.0  THEN 

Tempi =  Temp  +  TwoPi) 

GSTimO : =  Temp) 

END)  {  Function  GSTimO  } 

{ 


A-t 


{ 


PROCEDURE  LSTIME 

This  procedure  finds  the  Local  Sidereal  time  at  a  given  location. 


Algorithm  :  Find  GST  through  the  routine 

Find  LST  and  check  for  size  and  quadrant 


Author 

j  Capt  Dave  Vallado  USAFA/DPAS  719- 

■472-4109  12  Aug  1988 

Inputs 

Lon 

3D 

t 

-  Site  longitude  (WEST  -) 

-  Julian  Date 

-2Pi  to  2Pi  rad 
days  from  4713  B.C. 

Outputs 

LST 

GST 

i 

-  Local  Sidereal  Time 

-  Greenwich  Sidereal  Time 

0.0  to  2P1  rad 

0.0  to  2Pi  rad 

Locals 

None. 

: 

Constants 

TwoPi 

> 

Two  times  Pi 

Coupling 
RealHOD 
GST  1 me 

: 

Real  HOD  function 

Finds  the  Greenwich  Sidereal  Time 

References 

Escobal 

Kaplan 

BMW 

i 

pg.  18  -  21 
pg.  330-332 
pg.  99  -100 

PROCEDURE  LSTlme  (  Lon.JD  t  Extended* 

VAR  LST, GST  t  Extended  )> 

CONST 

TvoPl  :  Extended  =  6.28318530717959) 

BEGIN 

GST  :=  GSTlme(  JD  )) 

LST  i=  Lon  *  GST) 

{  -  Check  quadrants  -  } 

LST  )=  RealMODf  LST.TwoPi  )) 

IF  LST  <  0.0  THEN 

LST<=  Lst  +  TvioPl) 

END)  {  Procedure  Lstime  } 


PROCEDURE  SUNRISSSET 


This  procedure  finds  the  Universal  tine  for  Sunrise  and  Sunset  given  the 
day  and  site  location.  Mote  the  use  of  degrees  and  radians  since  the 
Almanac  presents  the  algorithm  in  these  units. 

Algorithm  i 


Author  s  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  13  Jan  1991 

Inputs  i 

JDate  -  Julian  Date 

Lat  -  Site  latitude  (SOUTH  -) 

Lon  -  Site  longitude  (WEST  -) 

WhichKind  -  Character  for  which  rise/set 

Outputs  I 

UTSunRise  -  Universal  time  of  sunrise  at  lat-lon  hrs 

UTSunSet  -  Universal  time  of  sunset  at  lat-lon  hrs 

Locals  i 


Constants  t 

Rad  Radians  per  degree 

TwoPi 

Pi 

Coupling  : 

InvJulianDay  Finds  the  Tr  Da  Mn  Hr  Mi  Se  from  the  Julian  Date 

FindDays  Finds  the  days  from  1  Jan  of  a  year 

ArcSln  Arc  sine  function 

ArcCos  Arc  cosine  function 

References  i 

Almanac  For  Computers  1990  pg.  B5-B6 


days  from  4713  B.C. 
-Pi/2  to  Pi/2  rad 
-2P1  to  2P1  rad 
•S*  'C'  !N*  'A* 


} 

PROCEDURE  SUNRISESET  (  JDate, Lat , Lon  i  Extended; 

WhichKind  ;  CHAR; 

VAR  UTSunRise,  UTSunSet  <  Extended  ); 

CONST 

Rad  ;  Extended  =  57.29577951308230; 

TwoPi  <  Extended  =  6.28318530717959; 

Pi  <  Extended  =  3.14159265358979; 

VAR 

Z,t,m,l,ra,sindelta, delta, h, eee, days  ;  Extended; 
year, month, day, hr, min  i  Integer; 

BEGIN 

CASE  WhichKind  OF 

•S'  :  Z;=  (90.0+50.0/60.0  )/Rad;  {  Sunrise  /  set  } 

•C'  i  Z;=  96.0  /  Rad;  {  Civil  } 

'N'  $  Zt=  102.0  /  Rad;  {  Nautical  } 

•A'  :  Z;=  108.0  /  Rad;  {  Astronomical  } 

END;  {  Case  } 

invJulianDayf  JDate,  Year, Honth, Day, Hr, Min, Sec  ); 

FindDays(  Year, Month, Day, Hr, Min, Sec,  Days  ); 

{ -  Sunrise  - } 

t  ;=  Days  +  (6.0  -  Lon*Rad/15.0)/24.0;  {days} 

H  ;=  0.985600*t  -  3.289;  {Deg} 

L  ;=  H  +  1.916*Sin(  M/Rad  )  +  0.020*Sln(  2.0*M/Rad  )  +  282.634;  {deg} 

I.  «=  RealMOD(  L, 360.0  ); 

Ra;=  ArcTan(  0.91746*Tan(L/Rad)  );  {  rad  } 

IF  Ra  <  0.0  THEN 

Rai  =  Ra  +  TwoPi; 

IF  (L  >  180.0)  and  (Ra  <  Pi)  THEN 
Ra;=  Ra  +  Pi; 

IF  (L  <  180.0)  and  (Ra  >  Pi)  THEN 
Rai=  Ra  -  Pi; 

SlnDelta;=  0.39782*Sln(  L/Rad  );  {  rad  } 

Oelta:=  ArcSin(  SinDelta  );  {rad  } 

Hi  =  ArcCos(  (Cos(z)  -  3inDelta+Sin(Lat) )  /  (Cos(Delta)*Cos ( Lat )  )  );  {rad} 
Hi =  TwoPi  -  H; 

ti=  H*Rad/15.0  +  RA*Rad/15.0  -  0.065710*t  -  6.622; 

T:=  RealHOD(  T,  24.0  ); 

UTSunRise i=  T  -  Lon*Rad/15.0;  {hrs} 

UTSunRlsei=  RealMOD(  UTSunRise,  24.0  }t 
IF  UTSunRise  <0.0  THEN 

UTSunRise i-  24.0  +  UTSunRise; 

{  -  Sunset  - } 

t  i=  Days  +  (18.0  -  Lon*Rad/15.0)/24.0;  {  days  } 

M  i=  0.985600*t  -  3.289;  {Deg} 

L  i=  M  +  1.916*Sln(  M/Rad  )  +  0.020*Sln(  2.0*M/Rad  )  +  282.634;  {deg) 

L  t=  RealMOD(  L, 360.0  ); 

Ra:=  ArcTan(  0.91746»Tan(L/Rad)  );  {  rad  } 

IF  Ra  <  0.0  THEN 

Rai=  Ra  +  TwoPi; 

IF  (L  >  180.0)  and  (Ra  <  Pi)  THEN 
Rai=  Ra  +  Pi; 

IF  (l  <  180.0)  and  (Ra  >  Pi)  THEN 
Rai=  Ra  -  Pi; 

SinDeltat=  0.39782*Sln(  L/Rad  );  {  rad  } 

Deltat=  ArcStn(  SinDelta  );  {rad  } 

H  i=  ArcC03(  (Cos(z)  -  SlnDelta*Sln(Lat))  /  (Cos(Delta)‘Cos(Lat)  )  );  {rad} 
t  :=  H*Rad/15.0  +  RA*Rad/15.0  -  0.065710*t  -  6.622; 

UTSunSet i=  T  -  Lon+Rad/15.0;  {hrs} 

UTSunSet i=  RealM0D(  UTSunSet,  24.0  ); 

IF  UTSun8et  <0.0  THEN 

UTSunSeti=  24.0  +  utSunSet; 

END;  (  Procedure  SunRlaeSet  } 

{ 
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|  PROCEDURE  HHSTOUT 

1 

1  This  procedure  converts  Hours,  Minute*  and  Seconds  into  Universal  Tine. 

Algorithm 

:  Calculate  the  answer 

Author 

t  Capt  Dave  Vallado  USAFA/DFAS 

719-472-4109  12  Aug  1988 

Inputs 

t 

Hr 

-  Hours 

0  ..  24  ex.  2 

Min 

-  Minutes 

0  ..  59  ex.  39 

Sec 

-  Seconds 

0.0  ..  59.99  ex.  57.29 

Outputs 

j 

UT 

-  Universal  Tie* 

HrMln.Sec  ex. 239. 5729 

Locals 

t 

i  None. 

i 

I  Constants 

s 

1  None . 

i 

1  Coupling 

: 

PROCEDURE  HHStoUT  (  Hr, Min 

Sac 

VAR  UT 

BEGIN 

UTi  =  Hr*100.0  +  Min  +  Sec/100. 0; 
END;  {  Procedure  HHStoUT  } 


t  Intagar; 
i  Extended; 
t  Extended  ); 


!  Constanta 


PROCEDURE  UTtOHMS 


BEGIN 

Hr  :=  TRUNC(  UT/100.0  ); 
Hlm=  TRUNC(  UT-Hr*100.0  ); 
Sec:  =  FRAC<  UT  )  *  100.0; 
END;  {  Procedure  UTtoHMS  } 


(  UT 

VAR  Hr, Kin 
VAR  Sac 


s  Extended; 

:  Integer; 
t  Ixtendad  ); 


PROCEDURE  HHSTORAD 


This  procedure  converts  Hours/  minutes  and  seconds  into  radians.  Notice 
the  conversion  0.2617  is  simply  the  radian  equivalent  of  IS  degrees. 


Algorithm  i  Calculate  the  answer 


Author 

;  capt  Dave  Vallado  USAFA/DPAS 

719-472-4109 

12  Aug  1988 

Inputs 

• 

0  ..  24 

ax.  10 

Hr 

-  Hours 

Min 

-  Minutes 

0  ..  59 

ex.  15 

Sec 

-  Seconds 

0.0  ..  59. 

99  ex.  30.00 

Outputs 

i 

HHS 

-  Result 

rad 

ex.  2.6856253 

Locals 

None. 


Constants  i 

None. 

Coupling  i 

None . 


} 


PROCEDURE  HHStoRad  (  Hr, Min 

Sec 

VAR  HHS 

BEGIN 

HMSi=  (  Hr  +  Min/60.0  +  Sec/3600.0  )*0. 261799387; 
END i  {  Procedure  HHStoRad  } 


t  Integer} 
t  Extended) 
t  Extended  ) ; 


PROCEDURE  RADTOHM8 


This  procedure  converts  radians  into  Hours/  minutes  and  seconds.  Notice 
the  conversion  0.2617  is  simply  the  radian  equivalent  of  IS  degrees. 


Algorithm 


Author 


Inputs 

HHS 


Outputs 

Hr 

Min 

Sec 


Locals 

None. 


Constants 
None . 


Coupling 

None. 


i  Convert  incoming  radians  to  hours 
Calculate  the  answer 


i  Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  12  Aug  1988 


-  Result 


rad 


ex.  2.6856253 


-  Hours 

-  Minutes 

-  Seconds 


0 

0 

0.0 


24 

59 


ex. 

ex. 


5s. 99  ex. 


10 

15 

30.00 


i 


PROCEDURE  RadtoHMS  (  HHS  i  Extended; 

VAR  Hr, Kin  i  Integer; 

VAR  Sec  t  Extended  ); 

BEGIN 

HHS  ;=  HHS  /  0.261799387; 

Hr  ;=  TRUNC(  HHS  ); 

Mim=  TRUNC(  (HKS  -Hr)*60.0  ); 

Sect=  (HHS  -Hr-Kln/60 .0  )  *  3600.0; 

END;  {  Procedure  RadloHHS  } 


PROCEDURE  DMSTORAD 


This  procedure  converts  Degrees/  minutes  and  seconds  into  radians. 
Algorithm  :  Calculate  the  answer 

Author  :  Capt  Dave  Vallado  USAPA/DPAS  719-472-4109  25  Aug  1988 


Inputs 

Deg 

-  Degrees 

0  .. 

360 

•X. 

98 

Min 

-  Minutes 

0  .. 

59 

•X. 

25 

Sec 

-  Seconds 

0  ♦  0  e  • 

59.99 

ex. 

30.00 

Outputs 

DMS 

-  Result 

rad 

•  Xe 

1.717840 

locals 

None. 


Constants  : 

Rad  Degrees  per  Radian 

Coupling  t 

None. 

- } 


PROCEDURE  DMStoRad  (  Deg, Min 

Sec 

VAR  DMS 

CONST 

Rad  s  Extended  =  57.29577951308230} 
BEGIN 


DMSi=  (  Deg  +  Min/60.0  +  Sec/3600.0  )  /  Radi 
END)  {  Procedure  DMStoRad  } 


Integer; 
Extended; 
Extended  ); 


{  - 

I 

I  PROCEDURE  RADTODMS 


This  procedure  converts  radians  into  Degrees,  minutes  and  sjconds. 


Algorithm 

;  Calculate  the  answer 

Author 

i  Capt  Dave  Vallado  USAPA/DPAS 

719-472-4109 

12  Aug  1988 

Inputs 

t 

DMS 

-  Result 

rad 

ex.  1.717840 

Outputs 

i 

Deg 

-  Degrees 

0  ..  360 

ex.  98 

Kin 

-  Minutes 

0  ..  59 

ex.  25 

Sec 

-  Seconds 

0.0  ..  59. 

99  ex.  30.00 

Locals  t 

None. 

Constants  : 

Rad  Degrees  per  Radian 

Coupling  i 

None . 

- } 


PROCEDURE  RadtoDMS  (  DMS  i  Extended; 

VAR  Deg, Min  i  Integer; 

VAR  See  i  Extended  ); 

CONST 

Rad  i  Extended  =  57.29577951308230; 

BEGIN 

DHS:=  DMS  *  Rad; 

Degt=  TRUHC(  DMS  ); 

Hlni=  TRUHC(  (DMS-Deg)*(0.0  ); 

Sec:=  ( DHS-Deg-Mln/6 0 . 0  )  *  3600.0; 

END;  {  Procedure  RadtoDMS  } 

{ 
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} 

{ - 

I 

I  PROCEDURE  SITE 

I 

I  This  procedure  finds  the  position  and  velocity  vectors  for  a  site.  The 
I  answer  is  returned  in  the  Geocentric  Equatorial  (IJK)  coordinate  system. 


I  Algorithm  s  Set  up  constants 
I  Find  x  and  a  values 

I  Find  position  vector  directly 

>  Call  cross  to  find  the  velocity  vector 

I  Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I  Inputs  t 

I  Lat  -  Geodetic  Latitude  -Pi/2  to  Pi/2  rad 

I  Alt  -  Altitude  DU 

I  LST  -  Local  Sidereal  Time  -2Pi  to  2Pi  rad 

I 

I  Outputs  I 

I  RS  -  IJK  Site  position  vector  DU 

I  VS  -  IJK  Site  velocity  vector  DU/TU 

I  Locals  t 

I  EarthRate  -  IJK  Earth's  rotation  rate  vector  rad/TU 

I  SlnLat  -  Variable  containing  sln(  Lat:  )  rad 

I  Temp  -  Temporary  Extended  value  , 

i  x  -  x  component  of  site  vector  DU 

I  z  -  z  component  of  site  vector  DU 

I  Constants  s 

I  EESqrd  -  Eccentricity  of  Earth's  shape  sqrd 

!  OmegaEarth  -  Angular  rotation  of  Earth  (Rad/TU) 

I  Coupling  i 

I  Hag  Magnitude  of  a  vector 

!  Cross  Cross  product  of  two  vectors 

I  References  i 

!  Escobal  pg.  26  -  29  (Includes  Geocentric  Lat  formulation  also) 

I  Kaplan  pg.  334-336 

!  BMW  pg.  94  -  98 

-  } 

PROCEDURE  Site  (  Lat, Alt, Lit  l  Extended) 

VAR  R8,VS  i  Vector  )> 

CONST 

EESqrd  >  Extended  =  0.00669437999013; 

OmegaEarth  :  Extended  =  0.0538335906868876) 

VAR 

SinLat,  Temp,  x,  z  :  Extended) 

EarthRate  i  Vector; 

BEGIN 

{  -  Initialize  values  -  ) 

SinLat  i  =  SIN(  Lat  )> 

Earthrate(l]i-  0.0) 

Earthrate{2 j i=  0.0) 

Earthrate[3}i=  OmegaEarth; 

{ -  Find  x  and  z  components  of  site  vector  - } 

Temp  «=  SQRT(  1.0  -  (  BESqrd*SlnLat*SlnLat  )  )) 
x  «=  (  (  1.0/Temp  )  +  Alt  )*C0S(  Lat  )) 

z  i=  (  ( (1.0-EESqrd)/Temp)  +  Alt  )*SlnLat; 

{ -  Find  Site  position  vector  - ) 

RSI  1 )  i=  x  *  C0S(  Lst  ); 

RSI 2 ]  i=  x  *  SIN(  Lst  )) 

RS(3)  !=  z; 

MAG(  RS  )) 

{ -  Find  site  velocity  vector  -  ) 


CROSS(  Earthrate,RS,VS  ); 
END)  {  Procedure  Site  } 

{ 
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I  PROCEDURE  RVToPOS 

I  This  procedure  finds  range  and  velocity  vectors  for  a  satellite  from  a  radar 
1  site  in  the  Topocentric  Horizon  (SBZ)  system. 

I  Algorithm  s  Assign  temp  values  to  limit  number  of  trig  operations 
I  Find  SBZ  position  vector  and  magnitude  directly 

1  Find  SBZ  velocity  vector  and  magnitude  directly 

I  Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

!  Inputs  : 

I  Rho  -  Satellite  range  from  site 

I  Az  -  Azimuth 

I  El  -  Elevation 

1  DRho  -  Range  Rate 

i  DAz  -  Azimuth  Rate 

i  DEI  -  Elevation  rate 

I 

i  Outputs  : 

i  RhoVec  -  SEZ  Satellite  range  vector  DU 

I  DRhoVec  -  SBZ  Satellite  velocity  vector  DU  /  TU 

I  Locals  s 

I  SlnEi  -  Variable  for  sln(  B1  ) 

I  CosEi  -  Variable  for  cos{  B1  ) 

I  SinAz  -  Variable  for  sin(  Az  ) 

I  CosAz  -  Variable  for  cos(  Az  ) 

I  Constants  : 

!  None. 

I 

I  Coupling  : 

I  Hag  Magnitude  of  a  vector 

I  References  : 

!  BMW  pg.  84  -  85 

- } 

PROCEDURE  RVToPOS  (  Rho , Ax , El , DRho , DAI , DEI  i  Extended? 

VAR  Rhovec, DRhovec  i  Vector  )? 

VAR 

SlnEi,  CosEi ,  SinAz,  CosAz  i  Extended? 

BEGIN 

C  -  Initialize  values  -  ) 

SlnEi «=  SIN(El)? 

CosEi i =  COS (El)? 

SlnAz:=  SIN(Az) ? 

CosAz i -  COS(Az) ? 

{  -  Form  SBZ  range  vector  -  } 

RhovocU]  ;=  -Rho*CosEl*CosAz? 

Rhovec(2]  :=  Rho*CosEL*81nAz? 

Rhovec(3J  ?=  Rho*SinBl? 

HAG(  RhoVec  )? 

{  -  Form  SEZ  velocity  vector  -  } 

DRhovecIl)  :=  -Drho*CosBl*CosAz  +  RhO*SinBl*Del*CosAz  +  Rho*CosBl*SlnAz*Daz? 
DRhovec! 2)  ?=  Drho*CosBl*SlnAz  -  Rho*SlnBl*Del*SinAz  +  Rho*CosEl*CosAa*Daz? 
DRhovec(3)  i=  Drho*SinBl  +  Rho*Del*CosEl? 

MAG(  DRhoVec  )? 

END?  {  Procedure  RVToPOS  } 

{ 


DU 

0.0  to  2Fi  rad 
-Pi/2  to  Pl/2  rad 
DU  /  TU 
rad  /  TU 
rad  /  TU 
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{ - 

I 

j  PROCEDURE  Track 

I 

1  This  procedure  finds  range  and  velocity  vectora  In  the  Geocentric  Equatorial 
!  (1JK)  system  given  the  following  Input  from  a  radar  site. 

I 

I  Algorithm  t  Find  constant  values 
j  Find  SEZ  vectors  from  RVToPOS 

j  Rotate  to  find  IJK  vectora 

I 

I  Author  i  Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  12  Aug  1988 

I  Inputs  » 

j  Rho  -  Satellite  range  from  site 

I  Az  -  A2lmuth 

)  El  -  Elevation 

j  DRho  -  Range  Rate 

I  DAz  -  Azimuth  Rate 

j  DEI  -  Elevation  rate 

]  Lat  -  Geodetic  Latitude 

!  LST  -  Local  SldaBxtended  Time 

I  RS  -  IJK  Site  position  vector 

I  Outputs  t 

I  R  -  IJK  Satellite  position  vector  DU 

I  V  -  IJK  Satellite  velocity  vector  DU  /  TU 

I  Locals  t 

I  WCrossR  -  Cross  product  result 

I  RhoVec  -  SEZ  range  vector  from  site 

I  DRhoVac  -  SEZ  velocity  vector  from  site 

j  TampVec  -  Temporary  vector 

j  RhoV  -  IJK  range  vector  from  site 

I  DRhoV  -  IJK  velocity  vector  from  site 

j  EarthRate  -  IJK  Earth's  rotation  rate  vector 

I 

I  Constants  i 

I  HalfPl 

I  OmegaEarth  -  Angular  rotation  of  Earth  (Rad/TU; 

I  Coupling  i 

I  RVToPOS  Find  R  and  V  from  site  In  Topocentrlc  Horizon  (SEZ)  system 

i  Cross  Cross  product  of  two  vectors 

!  Addvec  Add  two  vectors  together 

I  Rot3  Rotation  about  the  3rd  axis 

I  Rot 2  Rotation  about  the  2nd  axis 

I 

I  References  i 

I  BHW  pg.  85-89,  100-101 

-  } 

PROCEDURE  Track  (  Rho, Az, El, DRho, DAZ, DEI, 

Lat, Let  i  Extended; 

RS  i  Vector; 

VAR  R,V  ;  Vector  ); 

CONST 

HalfPl  i  Extended  *  1.57079632679490; 

OmegaEarth  i  Extended  *  0.0588335906868878; 

VAR 

WCrossR,  RhoVec,  DRhoVec,  TempVec,  RhoV,  DRhoV,  EarthRate  ;  Vector; 

BEGIN 

(  -  Initialize  values  -  } 

Earthrate[l]i=  0.0; 

Earthrate|2]i=  0.0; 

Earthrat*i3]i=  OmegaEarth; 

{ -  Pin<j  SEZ  range  and  velocity  vectors -  } 

RVToPOS (  Rho, Az, El, DRho, DAz, DEI, RhoVec, DRhoVec  ); 

{ -  Perform  SEZ  to  UK  transformation - ) 

R0T2 (  RhoVec  ,Lat-HalfPl,  TempVec  ); 

R0T3(  TempVec,  -LST  ,  RhoV  ); 

ROT2(  DRhoVec, Lat-HalfPi,  TempVec  ); 

R0T3<  TempVec,  -LST  ,  DRhoV  ); 

{  -  Plnd  IJK  range  and  velocity  vectors -  } 

ADDVEC (  RhoV.RS.R  ); 

CROSS  (  Earthrate.R  .WCrossR  ); 

ADDVEC (  DRhoV, WCrossR, V  ); 

END;  (  Procedure  Track  } 

{ 


DU  /  TU 
DU 

DU  /  TU 
DU 

DU  /  TU 
rad  /  TU 


DU 

0.0  to  2Pi  rad 
-Pi/2  to  Pi/2  rad 
DU  /  TU 
rad  /  TU 
rad  /  TU 

-Pl/2  to  Pl/2  rad 
-2P1  to  2Pi  rad 
DU 


A-15 


PROCEDURE  Razel 


This  procedure  calculates  Range  Azimuth  and  Elevation  and  their  rates  given 
the  Geocentric  Equatorial  (IJX)  Position  and  Velocity  vectors.  Notice  the 
value  of  small  as  it  can  affect  rate  term  calculations.  (See  Example  #4 ) 


Algorithm  i  Find  constant  values 

Loop  to  find  range  and  velocity  vectors 
Rotate  to  find  SSZ  vectors 

Use  if  statments  to  find  As  and  El  including  special  cases 
Author  s  Capt  Dave  Uado  U8AFA/DPAS  719-472-4109  27  Mar  1990 


Inputs 

I 

R 

-  IJK  Position  Vactor 

V 

-  IJK  Velocity  Vector 

Lat 

-  Geodetic  Latitude 

LST 

-  Local  Sidereal  Time 

RS 

-  IJK  Site  Position  Vector 

DU 

DU  /  TU 

-Pi/2  to  Pi/2  rad 
-2Pi  to  Pi  rad 
DU 


Outputs 

> 

Rho 

-  Satellite  Range  from  site 

Az 

-  Azimuth 

El 

-  Elevation 

DRhO 

-  Range  Rate 

DAZ 

-  Azimuth  Rate 

DEI 

-  Elevation  rate 

DUS 

0.0  to  2Pi  rad 
-Pi/2  to  Pi/2  rad 
DU  /  TU 
rad  /  TU 
rad  /  TU 


Locals 

RhoV 

DRhoV 

RhoVec 

DRhoVec 

WCrossR 

EarthRate 

TempVec 

Temp 

Tempi 

l 


-  IJK  Range  Vector  from  site 

-  IJX  Velocity  Vector  frost  site 

-  SEZ  Range  vector  from  site 

-  SEZ  Velocity  vactor  from  site 

-  Cross  product  result 

-  IJK  Barth's  rotation  rate  vector 

-  Temporary  vector 

-  Temporary  Extended  value 

-  Temporary  Extended  value 

-  Index 


DU 

DU  /  TU 

DU 

DU 

DU  /  TU 
rad  /  TU 


Constants  t 
HalfPl 
Pi 

OmegaEarth  -  Angular  rotation  of  Earth  (Rad/TU) 
Small  -  Tolerance  for  roundoff  errors 


Coupling 
Hag 
Cross 
Rot  3 
Rot  2 
Atan2 
Dot 


Magnitude  of  a  vector 
Cross  product  of  two  vectors 
Rotation  about  the  3rd  axis 
Rotation  about  the  2nd  axis 

Arc  tangenr  function  which  also  resloves  quadrants 
Dot  product  of  two  vectors 


References 

BMW 


i 

pg.  84-89,  100-101 


} 
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} 

PROCEDURE  Razel 


CONST 

HalfPi  ; 
Pi  t 
OmegaBarth  ; 
Small  i 


(  R,V,RS  l  Vac tor; 

Lat,Lst  ;  Extended; 

VAR  Rho,Az,El,DRho,DAz,DEl  ;  Extandad  )> 

Extended  =  1.57079632679490; 

Extended  =  3.14159265358979; 

Extended  =  0.0588335906868878; 

Extended  =  0.000001; 


VAR 

RhoV,  DRhoV ,  RhoVec,  DRhoVec,  WCrossR,  EarthRate,  TempVec  :  Vector; 
Temp,  Tempi  t  Extended; 


i  i  Integer; 

BEGIN 

{  -  Initialize  valuea  -  } 


Barthrate[l];=  0.0; 
Earthrate[2];=  0.0; 
Earthrate[3 j ;=  OmegaBarth; 


{ -  Find  xjk  range  vector  from  aite  to  eatellite  - } 

CROSS (  EarthRate.R, WCrossR  ); 

FOR  1;=1  to  3  DO 
BEGIN 

RhoVll)i=  R(i]  -  RSlil; 

DRhoV ( 1  ]  ;  =  V[ 1]  -  WCrossR(i); 

END; 

MAG(  RhoV  ); 

Rho;=  RhoV [ 4 ) ; 


{ -  Convert  to  SBZ  for  calculations  - } 

ROT3(  RhoV  ,  L3T  ,  TempVec  ); 

ROT2 (  TempVec, HalfPi-Lat,  RhoVec  ); 

ROT 3 (  DRhoV,  1ST  ,  TempVec  ); 

ROT 2 (  TempVec, HalfPl-Lat,  DRhoVec  ); 


{  -  Calculate  Azimuth  and  Elevation  - -  } 

Temp;®  SQRT(  RhoVec(l]*RhoVecIl]  +  RhoVect2]*RhoVec[2)  ); 

IF  ABS(  RhoVec[2]  )  <  Small  THEN 
IF  Temp  <  Small  THEN 
BEGIN 

Tempi;®  SQRT(  DRhoVec[l]*DRhoVec(l]  +  DRhoVec(2J*DRhoVec( 2)  ); 
Ax;®  AT  an  2  (  DRhoVec[2  j/Templ  ,  -DRhoVec[  D/Templ  ); 

END 

ELSE 

IF  RhoVectl)  >  0.0  THEN 
Az;=  Pi 
ELSE 

AZl®  0.0 

ELSE 

Az;=  AT AN 2 (  RhoVec[2)/Temp  ,  -RhoVec[l]/Temp  ); 


IF  (  Temp  <  Small  )  THEN 
Elt®  HalfPi 
ELSE 

Eli®  ATAN2(  RhoVec t 3 ]/Rho  ,  Temp/Rho  ); 

{  -  Calculate  Range,  Azimuth  and  Elevation  rates  -  ) 

DRho;=  DOT(  RhoVec, DRhoVec  )  /  Rho; 

IP  ABS(  Temp  )  >  Small  TH3M 

DAz;=  (  DRhoVectl)*RhoVecl2]  ~  DRhoVec [ 2 ] *RhoVec ( 1 ]  )  /  (Temp* Temp) 
ELSE 

DAz;=  0.0; 

IF  ABS(  Temp  )  >  0.000000001  THEN 

DE1;=  (  DRhoVec! 3]  -  DRho*SIN(  El  )  )  /  Temp 
ELSE 

DEI;®  0.0; 

END;  {  Procedure  Razel  } 

{ 
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{ 


PROCEDURE  Elorb 


This  procedure  finds  the  classical  orbital  elements  given  the  Geocentric 
Equatorial  Position  and  Velocity  vectors.  Special  cases  for  equatorial 
and  circular  orbits  are  also  handled.  IF  elements  are  Infinite,  they 
are  set  to  999999.9.  If  elements  are  Undefined,  they  are  set  to  999999.1. 
Be  sure  to  check  for  these  during  output  11 


Algorithm  t  Initialze  variables 

If  the  Hbar  magnitude  exists,  continue,  otherwise  exit  and 
assign  undefined  values 
Find  vectors  and  values 

Determine  the  type  of  orbit  with  IF  statements 
Find  angles  depending  on  the  orbit  type 

Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


Inputs 

t 

R 

-  IJK  Position  vector 

DU 

V 

-  UK  Velocity  vector 

DU  /  TU 

Outputs 

t 

p 

-  Seml-latus  rectum 

DU 

A 

-  semi-major  axis 

DU 

E 

-  eccentricity 

Inc 

-  inclination 

0.0 

to 

Pi  rad 

Omaga 

-  Longitude  of  Ascending  Node 

0.0 

to 

2P1 

rad 

Argp 

-  Argument  of  Perigee 

0.0 

to 

2P1 

rad 

NU 

-  True  anomaly 

0.0 

to 

2P1 

rad 

H 

-  Mean  anomaly 

0.0 

to 

2Pl 

rad 

U 

-  Argument  of  Latitude  (Cl) 

0.0 

to 

2Pl 

rad 

L 

-  True  Longitude  (CE) 

0.0 

to 

2P1 

rad 

CapPi 

-  Longitude  of  Perlapsls  (SR) 

0.0 

to 

2P1 

rad 

Locals 

: 

Hbar 

-  Angular  Momentum  H  Vector 

DU2 

/  TU 

Ebar 

-  Eccentricity  E  Vector 

Hbar 

-  Line  of  Nodes  N  Vector 

cl 

-  V**2  -  u/R 

RDotV 

-  R  Dot  V 

c3 

-  Hk  unit  vector 

SHE 

-  Specflc  Mechanical  Energy 

DU2 

/  TU2 

1 

-  index 

E 

-  Eccentric  Anomaly 

rad 

D 

-  Parabolic  Eccentric  Anomaly 

rad 

F 

-  Hyperbolic  Eccentric  Anomaly 

rad 

Temp 

-  Temporary  variable 

TypeOrblt 

-  Type  of  orbit 

EE, 

El, 

CB, 

i  Cl 

Constants 

HalfPl 

Pi 

TwoPl 

Infinite 

Undefined 

Small 


Flag  for  an  lnflntlte  element 
Flag  for  an  undefined  clement 
Tolerance  for  roundoff  errors 


Coupling 

HAG 

CROSS 

DOT 

ArcCos 

ArcCosh 

Sinh 

Sgn 

Angle 


Magnitude  of  a  vector 

Cross  product  of  two  vectors 

DOT  product  of  two  vectors 

Arc  Cosine  function 

Inverse  Hyperbolic  cosine  function 

Hyperbolic  Sine  function 

-1.0  or  1.0  depending  on  the  sign 

Find  the  angle  between  two  vectors 


References 

BMW 

Bscobal 

Kaplan 


pg.  58  -  71,  181-188 
pg.  104-107 
pg.  29  -  37 


{ 


} 
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} 

PROCEDURE  Elorb 


:  Vector; 


(  R,V 

VAR  P,A,Ecc, Inc, Omega, Argp, 
NU,H,U,L,CapPi 


CONST 

HalfPl  i 

Pi  i 

TtfoPl  : 

Small  t 

Infinite  ; 

Undefined; 

VAR 


Extended  =  1.57079632679490; 
Extended  =  3.14159265358979; 
Extended  =  6.28318530717959; 
Extended  =  0.000001; 

Extended  =  999999.9; 

Extended  =  999999.1; 


cl,  RDotV,  c3,  SHE,  Temp,  ?,  D,  E 
Hbar,  Ebar,  Nbar 
1 

TypeOrbit 

BEGIN 

{  -  Initialise 


s  Extended; 
t  Vector; 
t  Integer; 

;  String! 2] ; 

values  - 


MAG(  R  ); 
MAG(  V  ); 


;  Extended  ) ; 


} 


{ -  Find  H  N  and  E  vectors  - } 

CROSS!  R,V,Hbar  ); 


IF  HBar[4]  >  Small  THEN 
BEGIN 

Nbar(l] ;=  -Hbar[2]; 

Nbar(2]t=  Hbar[lj; 

Nbar!3);=  0.0; 

MAG(  Nbar  ); 

cl  ;=  V[4]*V(4]  -  1.0/R(4] ; 

RDotV ;=  DOT(  R,V  ); 

FOR  If  1  to  3  DO 

Ebar[l];=  cl*Rll]  -  RDotV*V{ i] ; 
HAG(  Ebar  ); 


{ -  Find  a  e  and  seml-latus  rectum  - } 

SHE;=  (  V[4}*V[ 4J/2.0  )  -  (  1.0/R[4)  ); 

IP  ABS(  SHE  )  >  Small  THEN 
Ai=  -1.0  /  (2.0*SKB) 

ELSE 

A;  =  Infinite;  {  Parabola  ) 

Ecct=  Ebar!4]; 

P  i=  HBar [ 4 )‘HBar ( 4] ; 


{ -  rind  inclination  - } 

c3;  =  HBar( 3)/HBar!4] ; 

IF  ABS(  ABS(c3 )  -  1.0  )  <  Small  THEN 
IF  ABS(HBar [ 3 ] )  >  0.0  THEN 

{  -  Equatorial  Orbits  -  ) 

c3;=  SGN(HBar ( 3] )  *  1.0; 

Inc;  =  ARCCOS!  c3  ); 


{ -  Determine  type  of  orbit  for  later  use  - } 

{  —  Elliptical,  Parabolic,  Hyperbolic  Inclined  -  } 

TypeOrbit;1  'EX'; 

IF  Ecc  <  Small  THEN 

{  -  Circular  Equatorial  -  } 

IF  (  Inc  <  Small  )  or  (  ABS(Inc-Pi)  <  Small  )  THEN 
TypeOrblt;=  'CE' 

ELSE 

{  -  Circular  Inclined  -  } 

TypeOrbit;=  'Cl' 

ELSE 

{  —  Elliptical,  Parabolic,  Hyperbolic  Equatorial  —  } 

IF  (  Inc  <  Small  )  or  (  ABS(Inc-Pi)  <  Small  )  THEN 
TypeOrblt;=  'EE'; 
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} 


} 


{ -  Find  Longitude  of  Ascending  Node 

IF  NBar(4]  >  Small  THEN 
BEGIN 

Tempi =  Nbar[l]  /  NBar[4]; 

IF  ABS(Temp)  >  l.o  THEN 
Tempi*  SGN(Temp)  *  1.0; 

Omega  1=  ARCCOS(  Temp  )i 
IF  NBar[2]  <  0.0  THEN 

Omega t =  TwoPi  -  Omega; 

END 
ELSE 

Omega is  Undefined; 

{ - Find  Argument  of  perigee  — 

IF  TypeOrbit  =  'El'  THEN 
BEGIN 

ANGLE(  Nbar.Bbar,  Argp  ); 

IF  EBar[3J  <  0.0  THEN 
Argpi=  TwoPi  -  Argp) 

END 
ELSE 

Argpi=  Undefined; 

{ -  rind  True  Anomaly  at  Epoch  - ) 

IF  TypeOrblttl)  *  'S'  THEN 
BEGIN 

ANGLE (  Ebar,r,  Nu  ); 

IF  RDotV  <  0.0  THEN 
Nui=  TWOPl  -  NU) 

END 

ELSE 

Nui*  Undefined; 

{  -  Find  Argument  of  Latitude  -  Circular  Inclined  -  } 

IF  TypeOrbit  *  'Cl'  THEN 
BEGIN 

ANGLE (  MBar.R,  U  )) 

IF  R [ 3 1  <  0.0  THEN 
Ut=  TWOPl  -  U| 

END 

ELSE 

Ut*  Undefined; 

{  -  pind  Longitude  of  Perigee  -  Elliptical  Equatorial  -  } 

IF  (  EBar[4)  >  Small  )  and  (  TypeOrbit  *  'EE'  )  THEN 
BEGIN 

Tempi®  Bbar[l]/EBarl41; 

IF  ABS(Temp)  >  1.0  THEN 

Tempt*  SGN(Temp)  *  1.0; 

CapPli*  ARCC08 (  Temp  ); 

IF  Ebar[21  <  0.0  THEN 

CapPli*  TwoPi  -  CapPli 
IF  inc  >  HalfPi  THEN 

CapPli*  TwoPi  -  CapPi; 

END 

ELSE 

CapPli*  Undefined; 

{  -  Find  True  Longitude  -  Circular  Equatorial  -  } 

if  (  R( 4]  >  Small  )  and  (  TypeOrbit  *  'CE'  )  THEN 
BEGIN 

Tempi*  R(l)/R[4]| 

IF  ABS(Temp)  >  1.0  THEN 

Tempt*  SGN(Temp)  *  1.0; 

Li*  ARCCOS (  Temp  ); 

IF  R( 2 ]  <  0.0  THEN 
Lt=  TwoPi  -  L; 

IF  Inc  >  HalfPi  THEN 
Li*  TwoPi  -  L; 

END 

ELSE 

L:=  Undefined; 


( 
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{ - Find  Mean  Anomaly  for  all  orbit*  - - } 

{ - Hyperbolic  - } 

IF  (Ecc-1.0)  >  Small  THEN 
BEGIN 

Ft=  ArcCosH(  (Ecc+Cos(Nu))  /  <1.0+Ecc*Co*(Nu) )  ); 

H:=  Ecc*Slnh(  F  )  -  F; 

END 

ELSE 


{ - Parabolic - } 

IF  ABS(  Ecc-1.0  )  <  Small  THEN 
BEGIN 

Di=  SQRT(  p  )  4  ?an(  Nu  ); 

M:=  (1.0/6.0)*(  3.0*p*D  +  D*D*D  ); 

END 

ELSE 


{ - Elliptical - } 

IF  Ecc  >  Small  THEN 
BEGIN 

Tempi=  1.0  +  acc*Cos(Nu); 

IF  ABS(Temp)  <  Small  THEN 
Ki  =  0.0 
ELSE 
BEGIN 

cl Is  (  SQRT(1.0-Ecc*Bcc)*Sin(Nu)  )  /  Temp; 
c3i  =  (  Bcc+Cos(Nu)  )  /  Tamp i 
IF  ABS(cl)  >  1.0  THEN 
cl Is  SGN(Cl)  •  1.0; 

IF  ABS(c3)  >  1.0  THEN 
c3lE  3CN(c3)  *  1.0; 

Ei-  ATan2(  cl,c3  ); 

Hi =  K  -  Ecc*Sln(  E  )i 
END) 

END 

ELSE 


{ - Circular - } 

IF  TypaOrblt  »  'CE'  THEN 
Mi*  L 
ELSE 
Mi*  Ul 

Hi =  RBALH0D(  H.TUoPi  )| 

IF  M  <  0.0  THEN 
Mt=  H  *  TwoPil 

{)  IF  Show  =  'Y*  THEN 

{}  BEGIN 

{)  WriteLn(  'H  =  1 i6/Hbar[l]il3i7,Hbar[2Jil«i7,Hbar[3)il4i7,Hbarl4]il4i7  )> 

{)  WriteLnf  *N  =  ' i6,Nbar[l] il3i7,Nbarl 2] tl4i7,Nbar[3] il4i7,Nbar[4] tl4i7  )» 

{}  WritoLn(  ‘E  *  1 i6fEbar[l]il3i7iBbar[2]il4i7iEbart3]il4i7iEbar[4)il4s7  ); 

{}  HriteLn(  ' SMB=' i6,SHEtl3i7> '  DU2/TU2*  )) 

{}  WrlteLnj  'TypeOrbit  =  1 ,Typa0rbitt3  )i 

(}  END; 

{}  IF  Show  =  'S'  THEN 

{}  BEGIN 

{}  Writal.n(  FileOut, 'H  -  >i6,Hbar(l)il3i7<Hbar(2)tl4i7,Hbar[3]tl4t7,Hbar[4)il4i7 

{)  WriteLn(  FileOut, 'N  =  ' i6,Nbar(l) il3i7,Nbar{2) il4i7,Nbarl3) il4i7,Nbar[4) tl4i7 

(}  WritaLn(  FileOut, *E  =  • i6,Ebar[l] tl3«7,Ebar(2) il4i7,Bbar[3] i!4i7,Ebar(4]  il4i7 

{}  HritaLn(  FileOut, 'SHE=' |6,SHB|13|7, '  DU2/TU2 '  )> 

{}  WrlteLnj  FileOut, 'TypeOrbit  =  ' .TypeOrbit i 3  ); 

{}  END; 

END  {  If  Hbar[4]  >  0  the  orbit  is  possible  } 

ELSE 

BEGIN 

P  i=  Undefined; 

A  i=  Undefined; 

Ecc  i=  Undefined; 

Inc  t-  Undefined; 

Omegai-  Undefined; 

Argp  t=  Undefined; 

Nu  t=  Undefined; 

H  i=  Undefined; 

U  i=  Undefined; 

1  i-  Undefined; 

CapPii=  Undefined; 

END; 

END;  (  Procedure  Elorb  } 

{ 
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i  PROCEDURE  RandV 

I  This  procedure  finds  the  position  and  velocity  vectors  in  Geocentric 
!  Equatorial  (IJX)  system  given  the  classical  orbit  elements.  NOTICE 
I  P  is  used  for  calculations  and  that  semi-major  axis  a,  is  not.  This 
I  convention  allows  parabolic  orbits  to  be  treated  as  well  as  the  other 

I  conic  sections.  Notice  the  special  cases  leave  Argp,  Omega  and  Nu  equal 

1  to  2ero,  rather  than  setting  them  to  some  large  number  as  a  flag  for 

1  infinite  or  undefined.  This  allows  the  routine  to  process  different  types 

!  of  orbits  with  ONE  transformation  matrix  since  seros  will  leave  the  vectors 
I  unchanged  during  that  phase  of  the  transformation. 

I  Algorithm  :  Select  the  type  of  orbit  through  IP  statements 
!  and  assign  Omega,  Argp,  and  Nu 

I  Although  these  values  change,  they  are  NOT  passed  back 

i  Find  the  PQW  position  and  veocity  vectors 

I  Rotate  by  3-1-3  to  UK.  Order  is  Important 

1  Author  i  Capt  Dave  Vallado  USAFA/DPA8  719-472-4109  20  Sep  1990 

I  Inputs  t 


p 

-  Semi-latus  rectum 

DU 

E 

-  eccentricity 

0.0  to  ... 

Inc 

-  Inclination 

0.0  to  Pi 

rad 

Omega 

-  Longitude  of  Ascending  Node 

0.0  to  2Pl 

rad 

Argp 

-  Argument  of  Perigee 

0.0  to  2P1 

rad 

Nu 

-  True  anomaly 

0.0  to  2P1 

rad 

U 

-  Argument  of  Latitude 

(Cl) 

0.0  to  2P1 

rad 

L 

-  True  Longitude 

(CE) 

0.0  to  2Pl 

rad 

CapPl 

-  Longitude  of  Perlapsls 

(EE) 

0.0  to  2Pl 

rad 

Outputs 

t 

R 

-  IJK  Position  vector 

DU 

V 

-  IJK  Velocity  vector 

DU  /  TU 

Locals 

i 

Temp 

-  Temporary  Extended  value 

Rpqv 

-  PQW  Position  vector 

DU 

Vpqw 

-  PQW  Velocity  vector 

DU  /  TU 

TempVec 

-  PQW  Velocity  vector 

Constants  i 

Pi 

Small  -  Tolerance  for  roundoff  errors 


Coupling  : 

HAG  Magnitude  of  a  vector 

ROT 3  Rotation  about  the  3rd  axis 

ROT1  Rotation  about  the  1st  axis 

References  : 

BMW  pg.  71-73,  80-83 

Escobal  pg.  68-83 
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PROCEDURE  Rar.dV  (  F,E, Inc, Omega, Argp, Nu, 

U,L,CapPi  t  Extended; 

VAR  R,V  s  Vector  ); 

CONST 

Pi  ;  Extended  =  3.14159265358979; 

Small;  Extended  =  0.000001; 

VAR 

Temp  t  Extended; 

Rpqw,  Vpqw,  TempVec  t  Vector; 

BEGIN 

{ - 

I  Determine  what  type  of  orbit  la  Involved  and  aet  up  the 
I  set  up  angles  for  the  special  cases. 


IF  E  <  SMALL  THEN 

{  -  Circular  Equatorial  -  } 

IF  (  Inc  <  Small  )  or  (  ABSdnc  -  Pi)  <  Small  )  THEN 
BEGIN 

Argp  ;=  0.0; 

Omega :=  0.0; 

Nu  ;=  L; 

END 

ELSE 

{  -  Circular  Inclined  -  } 

BEGIN 

Argp;=  0.0; 

Nu  ;=  U; 

END 

ELSE 

{  -  Elliptical  Equatorial  -  } 

IF  (  Inc  <  Small  )  or  (  ABSflnc  -  Pi)  <  Small  )  THEN 
BEGIN 

Argp  Cappl; 

Omega :=  0.0; 

END; 


{  -  Form  PQW  position  and  velocity  vectors  -  } 

Temp:=  P  /  (1.0  +  E*C0S(NU)); 

Rpqw(l);=  Temp*COS(NU); 

Rpqw(2J;=  Temp*SIN(NU); 

Rpqw( 3] ; =  0.0; 

Vpqw(l];=  -SIN(NU)  /  SQRT(P) ; 

Vpqw[2] t=  (E  +  COS(NU) )  /  SQRT(P); 

Vpqv(3):=  0.0; 

MAG(  Rpqw  ); 

MAG(  Vpqw  ); 

{  -  Perform  transformation  to  IJX  -  } 

ROT3(  Rpqw  ,  -Argp  ,  TempVec  ); 

R0T1 (  TempVec,  -Inc  ,  TempVec  ); 

R0T3(  TempVec,  -Omega,  R  ); 

ROT3(  Vpqw  ,  -Argp  ,  TempVec  ); 

R0T1 (  TempVec,  -Inc  ,  TempVec  ); 

R0T3(  TempVec,  -Omega,  V  ); 

END;  {  Procedure  RandV  } 
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PROCEDURE  GIBBS 


This  procedure  performs  the  Gibbs  method  of  orbit  determination.  This 

method  determines  the  velocity  at  the  middle  point  of  the  3  given  position 
vectors.  Several  flags  are  passed  back. 

Fit  =  0  ok 

Fit  =  1  not  coplanar 

Fit  =  2  orbit  impossible 

The  Gibbs  method  is  best  suited  for  coplanar,  sequential  position  vectors 
which  are  more  than  about  10  deg  apart.  Notice  the  angle  is  passed  back 
so  the  user  may  make  a  decision  about  the  accuracy  of  the  calculations  as 
vectors  which  are  120  deg  apart  may  be  accurate,  while  vectors  8  deg 
apart  would  not.  The  method  will  calculate  the  resulting  velocity  using 
the  vectors  IN  THE  ORDER  GIVEN.  IF  the  calculations  are  not  possible, 

V2  is  set  to  0.0.  Notice  a  1  deg  tolerance  is  allowed  for  the  coplanar 
check.  This  is  necessary  to  allow  for  noisy  data  in  the  estimation  project. 


Algorithm 


Author 


Inputs 

R1 

R2 

R3 


:  Initialize  values  including  the  answer 
Find  if  the  vectors  are  coplanar,  else  set  a  flag 
Check  that  the  orbit  is  possible,  else  set  a  flag 
Find  the  largest  angle  between  the  vectors 
Calculate  the  answer 

1  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  28  Mar  1990 


-  IJK  Position  vector  #1 

-  IJK  Position  vector  #2 

-  IJK  Position  vector  #3 


DU 

DU 

DU 


OutPuts 

V2 

Theta 

Fit 


Locals 

tover2 

1 

Small 

rlmr2 

r3mrl 

r2mr3 

P 

<3 

w 

d 


n 

s 

b 

Thetal 

PN 

R1H 

dn 

nn 

i 


-  IJK  Velocity  Vector  for  R2  DU  /  TU 

-  Angle  between  vectors  rad 

-  Flag  indicating  success  0,  1,  2 


-  Tolerance  for  roundoff  errors 

-  Magnitude  of  rl  -  r2 

-  Magnitude  of  r3  -  rl 

-  Magnitude  of  r2  -  r3 

-  P  Vector  r2  x  r3 

-  0  Vactor  r3  x  rl 

-  W  Vector  rl  x  r2 

-  D  Vector  p  +  q  ♦  w 

-  N  Vector  (rl)p  +■  (r2)q  +  (r3)w 

-  S  Vector  (r2-r3)rl+(r3-rl)r2+(rl-r2)r3 

-  B  Vector  d  x  r2 

-  Temporary  angle  between  the  vectors  rad 

-  P  Unit  Vector 

-  Rl  Unit  Vector 

-  D  Unit  Vector 

-  N  Unit  Vector 

-  index 


Constants  i 
None. 


Coupling 

i 

MAG 

Magnitude  of  a  vector 

CROSS 

Cross  product  of  two  vectors 

DOT 

Dot  product  of  two  vectors 

ADD3VEC 

Add  three  vectors 

LNCOM2 

Multiply  two  vectors  by  two  constants 

LNCOM3 

Add  three  vectors  each  multiplied  by  a  constant 

NORM 

Creates  a  Unit  Vector 

ANGLE 

Angle  between  two  vectors 

References 

. 

BMW 

pg.  109-116 

Escobal 

pg.  306-307 

{ 


} 
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} 

PROCEDURE  GIBBS 


(  R1,R2,R3  :  Vector; 

VAR  V2  ;  Vector; 

VAR  Theta  s  Extended; 

VAR  fit  i  Integer  ); 

VAR 

tover2,  1,  Small,  rlmr2,  r3mrl,  r2mr3,  Thetal  t  Extended; 

p,  g,  w,  d,  n,  s,  b,  Pn,  RlN,Dn,nn  :  Vector; 

i  :  Integer; 

BEGIN 

{  -  Initialize  values  -  } 

Small :=  0.000001;  Theta:*  0.0;  Pit  :  =  0; 

Mag(  R1  );  Mag(  R2  );  Mag(  R3  ); 

FOR  i:=  1  to  4  DO 
V2[ 1 ] s=  0.0; 


{  - - 

I  Determine  if  the  vectors  are  coplanar.  The  DOT  product  of  R1  and  the 
1  normal  vector  of  R2  and  R3  will  be  0  if  all  three  vectors  are  coplanar. 

I  The  Vectors  are  normalized  to  accept  very  small  and  very  large 

!  vectors.  The  magnitudes  are  left  out  of  the  DOT  product  equation  : 

I  rln  dot  pn  =  rln  pn  Cos()  t  since  each  vector  is  normalized,  so  the 

I  magnitudes  are  1.0.  A  1  deg  tolerance  is  allowed  for  estimation,  and 

I  is  Implemented  by  allowing  the  angle  between  Rln  and  Pn  to  range  from 

I  89.0  to  91.0  deg,  or  Cos(89.0)  =  0.0174S2406. 


CROSS (  R2,R3,P  ); 

CROSS (  R3,R1,Q  ); 

CROSS {  R1,R2,W  ); 

NORM(  P,PN  ); 

NORM(  R1.R1N  ); 

IF  ABS(  DOT(RIN.PN)  )  >  0.017452406  THEN  {  Not  coplanar  } 

Fit!*  1 
ELSE 
BEGIN 

ADD3VEC (  P,Q,W,D  ); 

LNCOM3 (  Rl[ 4] ,R2[ 4] ,R3[4) ,P,Q,W,N  ); 

NORM)  N,NN  ); 

N0RH(  D,DN  ); 

{  - 

I  Determine  if  the  orbit  is  possible.  Both  D  and  N  must  be  in 
I  the  same  direction,  sud  non-zero. 

-  } 

IF  (  ABS(d[ 4 ) )<Small  )  or  (  AB3(n[4))<Small  )  or 
(  Dot(nn.dn)  <  Small  )  THEN 
Flt!=  2  {  Orbit  not  possible  } 

ELSE 

BEGIN 

Angle(  R1,R2,  Theta  ); 

Angle (  R2,R3,  Thetal  ); 

IF  Thetal  >  Theta  THEN 
Theta:*  Thetal; 

{ -  Perform  Gibbs  method  to  find  V2  - } 

Rlmr2t=  R1 [ 4  J-R2( 4 ] ; 

R3mrli=  R3[4]-R1(41; 

R2mr3:=  R2(4]-R3[4]; 
LNCOH3(Rlmr2,R3mrl,R2mr3,R3,R2,Rl,S) ; 

CROSS (  d,r2,b  ); 

L  :=  1.0  /  Sqrt(d(4)*n[4] ) ; 

Tover2 ! =  L  /  R2[4J; 

LNCOH2(Tover2,L,B,S,V2) ; 

END; 

END) 

{}  IF  (  Show  *  ' Y 1 )  and  (  Fit  *  0  )  THEN 
{}  BEGIN 

{}  WrlteLnf  'P  vector  =  ' !l6,P[l)i9:3,P[2):9!3,P[3]i9i3  ); 

{}  WriteLn(  ’Q  vector  =  ' >16,0(l]i9t3,QC2}t9t3,Q[3)>9i3  ); 

{}  WriteLn(  ‘W  vector  =  • il6,W( 1] :9:3,W(2 J i9i3,W[ 31 i9i3  ); 

{}  WriteLn(  'D  vector  =  * < 16 , D[ 1 ] 1 9 1 3 ,0[ 2 ) 1 9 1 3 ,D[ 3 ] 1 9 1 3  ); 

{}  HriteLn(  'N  vector  =  1 : 16, N[ 1 ] :9: 3,N( 2) !9i3,N[3] :9i3  ); 

{}  Wr lteLn(  *S  vector  =  * i16,S(1]i9i3,S[2)i9i3,S[3]i9i3  ); 

(}  WrlteLn(  'B  vector  =  ' :16,B( 1 ) :9:3,B( 2) :9:3,B(3 j :9:3  ); 

{}  END; 

END;  {  Procedure  Gibbs  } 
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} 

{ 


PROCEDURE  HERRGIBBS 


This  procedure  Implement*  the  Herrlck-Gibbs  approximation  for  orbit 
determination,  and  find*  the  middle  velocity  vector  for  the  3  given 
position  vectors.  The  method  is  good  for  fast  calculations  and  small 
angles,  <=  10  deg.  Notice  the  angle  is  passed  back  since  vectors  which 
are  12  deg  apart  stay  actually  be  accurate,  while  vectors  which  are  170  deg 
apart  would  not.  The  observations  MUST  be  sequential  and  taken  on  one 
revolution.  The  Use  of  Julian  Dates  for  input  makes  it  much  easier  to 
perform  calculations  where  the  sights  occur  around  midnight.  Several 
flags  are  passed  backt 

Fit  =  0  ok 

Fit  =  1  orbits  not  coplanar 

Fit  =  2  angles  bewteen  the  vectors  are  larger  than  10  deg 

Notice  a  1  deg  tolerance  is  allowed  for  the  coplanar  check.  This  is 
necessary  to  allow  for  noisy  data  in  the  estimation  project. 


Algorithm 


Author 


Inputs 

R1 

R2 

R3 

JD1 

JD2 

JD3 


:  Initialize  values  Including  the  answer 
Find  if  the  vectors  are  coplanar,  else  set  a  flag 
Find  the  largest  angle  between  the  vectors 
Calculate  the  Taylor  series  for  the  answer 

i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  28  Mar  1990 


-  1JX  Position  vector  41 

-  IJX  Position  vector  #2 

-  IJK  Position  vector  |3 

-  Julian  Date  of  lit  sighting 

-  Julian  Date  of  2nd  sighting 

-  Julian  Date  of  3rd  sighting 


DU 

DU 

DU 

days  from  4713  B.C. 
days  from  4713  B.C. 
days  from  4713  B.C. 


Outputs  t 

V2  -  IJK  velocity  Vector  for  R2 

Theta  -  Angle  between  vectors 

Fit  -  Flag  indicating  success 


DU  /  TU 
rad 

0,  1,  2 


Locals 

dt21 

; 

time  delta  between  rl  and  r2 

dt31 

- 

time  delta  between  r3  and  rl 

dt32 

- 

time  delta  between  r3  and  r2 

P 

- 

P  vector  r2  x  r3 

PN 

- 

P  Unit  Vector 

R1N 

- 

Rl  Unit  Vector 

Thetal 

- 

temporary  Angle  between  vectors 

TolAngle 

- 

Tolerance  angle  (10  deg) 

Terml 

- 

First  Term  for  HGibbs  expansion 

Term2 

- 

Second  Term  for  HGibbs  expansion 

Term3 

- 

Third  Term  for  HGibbs  expansion 

1 

- 

Index 

TU 

TU 

TU 


rad 

rad 


Constants 

TUMln 


i 

-  Minutes  in  each  Time  Unit 


13.44685108204 


Coupling  i 


MAG 

Magnitude  of  a  vector 

CROSS 

Cross  product  of  two  vectors 

DOT 

Dot  product  of  two  vectors 

ArcCos 

Arc  Cosine  function 

NORH 

Creates  a  Unit  Vector 

LNC0M3 

Combination  of  three  scalars  and  three  vectors 

ANGLE 

Angle  between  two  vectors 

References 

. 

Escobal 

pg.  254-256,  304-306 

{ 


} 


A-2S 


} 

PROCEDURE  HerrGibbs 


(  R1,R2,R3 
JD1,JD2,JD3 
VAR  V2 
VAR  Theta 
VAR  Fit 


: 

s 

: 

i 


Vac tor ) 

Extended; 

Vector; 

Extended; 

Xntagar 


CONST 

TUMln  i  Extended  =  13.44665108204; 

VAR 

dt21,  dt31,  dt32,  Terml,Term2,Term3, Thetal, TolAngles  Extended; 
p,  Pn,  Rln  t  Vector; 

L  ;  Integer; 

BEGIN 


{ 


Initialize  values 


} 


)> 


Fit  !=  0; 

Theta !=  0.0; 

Mag(  R1  ); 

Hag(  R2  ); 

Hagj  R3  ); 

FOR  l i=  1  to  4  DO 
V21 1 ] 1=  0.0; 

TolAnglei=  0.174532925; 

DT21:=  (JD2-JDl)*1440.0/TUMin; 

DT31;=  (JD3-JDl)*1440.0/TUMin;  {  differences  in  times  } 

DT32|=  (JD3-JD2)*1440.0/TUMin; 


{ - 

1  Determine  if  the  vectors  are  coplanar.  The  DOT  product  of  R1  and  the 
!  normal  vector  of  R2  and  R3  will  be  0  if  all  three  vectors  are  coplanar. 

i  The  Vectors  are  normalized  to  accept  very  small  and  very  large 

I  vectors.  The  magnitudes  are  left  out  of  the  DOT  product  equation  > 

!  rln  dot  pn  =  rln  pn  Cos()  i  since  each  vector  is  normalized,  so  the 

I  magnitudes  are  1.0.  A  1  deg  tolerance  is  allowed  for  estia^tlon,  and 
I  is  implemented  by  allowing  the  angle  between  Rln  and  Pn  to  range  from 

I  89.0  to  91.0  dog,  or  Cos(89.0)  =  0.017452406. 


CROSS (  R2.R3.P  ); 

N0RM(  P,PN  ); 

M0RM(  R1.R1N  ); 

IF  ABS(  DOT(RlN,PN)  )  >  0.017452406  THEN  {  Not  coplanar  } 

Fit ;=  1 
ELSE 
BEGIN 

{  - 

I  Check  the  size  of  the  angles  between  the  three  position  vectors. 

I  Herrick  Gibbs  only  gives  "reason  ,ble“  answers  when  the 
I  position  vectors  are  reasonably  close.  10  deg  is  only  an  estimate. 


Angle(  R1,R2,  Theta  ); 
Angle!  R2,R3,  Thetal  ); 
IF  Thetal  >  Theta  THEN 
Theta i =  Thetal; 

IF  Theta  >  TolAngle  THEN 
Flt:=  2; 


{  -  Perform  Herrlck-Glbbs  method  to  find  V2  -  } 

Terml:=  -dt32*(  1.0/(dt21*dt31)  +  1.0/(12*rl[ 4 )*rl[4 ]*rl[ 4] )  ); 
Term2:=  (dt32-dt21)*(  1.0/(dt21*dt32)  +  1.0/(12*r2[4J*r2[4]*r2[4))  ); 
Term3;=  dt21*<  1.0/(dt32*dt31)  +  1.0/(12*r3[4)*r3t4]*r3[4J)  ); 
LNCOH3(  Terml,Term2,Tera3,Rl,R2,R3,  V2  ); 

END;  {  if  not  coplanar  } 

END;  {  Procedure  HerrGibbs  } 

{ 
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PROCEDURE  FINDCandS 

I  This  procedure  calculates  the  C  and  S  functions  for  use  in  the  Universal 
Variable  calculations.  NOTE  equality  is  handled  by  the  series  expansion 
terms  to  eliminate  potential  discontinuities.  The  series  is  only  used  for 
negative  values  of  Z  since  the  truncation  results  in  rather  large  errors 
as  Z  gets  larger  than  about  10.0. 


Algorithm 


I  Author 

j  Inputs 
ZNew 


:  If  Z  is  greater  than  zero,  use  the  exact  formulae  else 
use  the  series  form 

:  Capt  Dave  Vallado  USAPA/DFAS  719-472-4109  30  Jan  1991 


-  Z  variable 


I  Outputs 
CNew 
SNew 

I  Locals 

ZNewSqrd 

ZNewFrth 

SqrtZ 

I  Constants 
None. 

|  Coupling 
None. 

I  References 
BHW 

!  Kaplan 


-  C  function  value 

-  S  function  value 


-  ZNew  squared 

-  ZNew  to  the  fourth  power 

-  Square  root  of  ZNew 


pg.  207-210 
pg.  304-305 


(Complete  graph  of  S  and  C) 


PROCEDURE  FindCandS 


(  ZNew 

VAR  CNew, SNew 


i  Extended) 
i  Extended  ); 


ZNewFrth, ZNewSqrd,  SqrtZ  :  Extended) 

BEGIN 

IF  ZNew  >0.0  THEN 
BEGIN 

SqrtZ  :=  SQRT(  Znew  )> 

CNew  :=  (1.0-CO3(  SqrtZ  ))  /  ZNew> 

SNew  s=  (SqrtZ-9IN{  SqrtZ  ))  /  (  SqrtZ*SqrtZ*SqrtZ  )) 

END 

ELSE 

BEGIN 

ZNewSqrd  i  =  ZHew*ZNew> 

ZNewFrth  :=  ZNewSqrd*ZNewSqrd) 

CNew  i=  0.5  -  ZNew/24.0  +  ZNewSqrd/720.0  -  (ZNewSqrd*ZNew)/40320.0 

+  ZNewPr th/3628800.0  -  ZNewFrth*ZNew/479001600.0) 

SNew  :=  1. 0/6.0  -  ZNew/120.0  +  ZNewSqrd/5040.0  -  (ZNewSqrd*ZNew)/362880.0 
+  ZNewFr th/39916 800.0  -  ZNewFrth*ZNew/6227020800.0) 

END) 

END;  {  Procedure  FindCandS  } 


} 

{ 


PROCEDURE  NEWTONR 


This  procedure  performs  the  Newton  Rhapson  Iteration  to  find  the 
Eccentric  Anomaly  given  the  Mean  anomaly.  The  True  Anomaly  la  also 
calculated. 

Algorithm  t  Setup  the  first  guess 

Loop  while  the  answer  has  not  converged 

Write  an  error  12  the  answer  doesn't  converge 

Find  the  True  Anomaly  using  ATAN2  to  resolve  quadrants 

Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 


Inputs 

e 

M 


I 

-  Eccentricity 

-  Mean  Anomaly 


0.0  -  1.0 

0.0  -  2P1  rad 


Outputs  : 

E0  -  Eccentric  Anomaly 

Nu  -  True  Anomaly 


0.0  -  2P1  rad 
0.0  -  2P1  rad 


Locals 

El 

Slnv 

Cosv 

Ktr 


t 

-  Eccontrlc  Anomaly,  next  value  rad 

-  Sine  of  Nu 

-  Cosine  of  Nu 

-  Index 


Constants 

None. 

t 

Coupling 

Atan2 

t 

Arc 

tangent 

function  which  also  resloves  quadrants 

References 

BMW 

: 

pg. 

184-186, 

220-222 

} 


PROCEDURE  NewtonR  {  t,M  i  Extended! 

VAR  E0,Nu  t  Extended  )> 

VAR 

El,  Slnv,  Cosv  t  Extended) 

Ktr  t  INTEGER) 

BEGIN 

{  -  Initialize  values  -  } 

E0  i=  Hi 
Ktr  i=  1) 

{  -  Newton  Iteration  for  Eccentric  Anomaly  -  } 

El)=  E0  -  (  (  E0  -  e*SIN(E0)-m  )  /  (  1.0  -  e*CO3(E0)  )  ); 

WHILE  (  ABS(Bl-BO)  >  0.0000001  )  and  (  Ktr  <=  20  )  DO 
BEGIN 
EOi?  El; 

El)=  E0  -  (  (  B0  -  e*SIN(B0)-m  )  /  (  1.0  -  e*COS(E0)  )  )) 

INC(  Ktr  )) 

END) 

IF  Ktr  >  20  THEN 

WrlteLn(  'NewtonRhapson  not  converged  In  20  Iterations'  )) 

{  -  Find  True  Anomaly  at  Epoch  - } 

Sinvi=  (  SQRT(  1.0-e*e  )  *  SIN(El)  )  /  (  1.0-e*C0S(Bl)  )) 

Cosv:=  (  COS(Bl)-e  )  /  (  1.0  -  e*COS(Bl)  )) 

NU  :=  ATAN2(  Sinv.Cosv  )) 

END)  (  Procedure  NewtonR  } 


{ 


} 

{ 


PROCEDURE  KEPLER 


j  This  procedure  solves  Keplers  problem  for  orbit  determination  and  returns  a 
I  future  Geocentric  Equatorial  (IJK)  position  and  velocity  vector.  The 
I  solution  procedure  uses  Universal  variables. 

I  Algorithm  s  Initialize  variables 

I  Find  size  and  shape  parameters  for  all  cases 

I  Setup  initial  guesses  with  IF  statements 

I  Loop  while  the  time  has  not  converged 

i  If  too  many  iterations!  print  an  error 

I  otherwise  calculate  the  answer 

I  Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I  Inputs  t 

I  Ro  -  IJK  Position  vector  -  initial  DU 

I  Vo  -  IJK  Velocity  vector  -  initial  DU  /  TU 

I  Time  -  Length  of  tlaM  to  propagate  TU 


Outputs 

I 

R 

- 

IJK  Position  vector 

V 

“ 

IJK  Velocity  vector 

Locals 

t 

F 

- 

f  expression 

G 

- 

g  expression 

FDot 

- 

f  dot  expression 

GDot 

- 

g  dot  expression 

XOld 

- 

Old  Universal  Variable  X 

XOldSqrd 

XOld  squared 

XNew 

- 

Hew  Universal  Variable  X 

XHewSqrd 

- 

XNew  squared 

ZNew 

- 

Hew  value  of  s 

CNev 

- 

C(z)  function 

SNew 

- 

S(z)  function 

DeltaT 

- 

change  in  t 

TimeHev 

- 

Hew  time 

RDotV 

Result  of  Ro  dot  Vo 

A 

- 

Semi  major  axis 

Alpha 

- 

Reciprocol  1/a 

SHE 

Specific  Hech  Energy 

Period 

- 

Time  period  for  satellite 

S 

- 

Variable  tor  parabolic  case 

W 

Variable  for  parabolic  case 

Temp 

- 

Temporary  Extended  value 

1 

- 

index 

DU 

DU  /  TU 


TU 

TU 


DU2  /  TU2 
TU 


Constants  ; 

HalfPl 

TvoPl 

Small  -  Tolerance  for  roundoff  errors 

Infinite  -  Flag  for  an  indefinite  element 

Coupling  i 

HAG  Magnitude  of  a  vector 

DOT  Dot  product  of  two  vectors 

REALHOD  REAL  HOD  function 

COT  Cotangent  function 

POWER  Raise  a  number  to  some  power 

SGN  Sign  of  a  number  +1  or  -1 

FindCandS  Find  C  and  8  functions 

Tan  Tangent  of  a  value 

References  i 

Kaplan  pg.  304-308  (  Includes  first  guess  for  x  if  parabolic) 

BMW  pg.  191-199,  203-212 


} 

PROCEDURE  Xepler  (  Ro,Vo  «  Victor  I 

Tim*  t  Extended; 

VAR  R/V  ;  Victor 

CONST 

KalfPl  ;  Extended  =  1,57079632679490; 

TwoPl  i  Extended  =  6.28318530717959; 

Small  t  Extended  =  0.000001; 

Infinite  i  Extended  =  999999.9; 

VAR 

F,  G,  EDot i  GDot,  Delta! ,  XOld,  XOldSqrd,  XNew,  XNewSqrd,  ZNew, 
CNew,  SNew,  TiraeNev,  RDotV,  A,  Alpha,  SMB,  Period,  8,  W,  Temp  t 
i  t  Integer; 

BEGIN 

{  -  Initialise  value*  -  } 

TimeNew  i=  -10.0; 

FOR  1»=  1  to  4  DO 
V[l);=  0.0; 

MAG(  Ro  ); 

KAG(  Vo  ); 

RDotV;*  nOT(  RO, Vo  ); 

{ -  Find  SHE,  Alpha,  and  A  - } 

SHE; =  (  Vo(4]*Vo(4]/2.0  )  -  {  1.0/Ro[4J  ); 

Alpha;*  -SHE* 2.0; 

IF  ABS(  SHE  )  >  Small  THEN  {  circle,  ellipse,  hyperbola  } 

A;  =  -1.0  /  (  2.0*SME  ) 

ELSE 

A;=  Infinite; 

IF  ABS(  Alpha  )  <  Small  THEN  {  Parabola  } 

Alpha;*  0.0; 


{  -  Setup  initial  guea*  for  x  - 

{ -  Circle  and  Bllipae - } 

IF  Alpha  >=  Small  THEN 
BEGIN 

Period;*  TvoPi  *  SQRT(  POWKR<  ABS(A),3.0  >  ); 

IF  ABS(  Time  )  >  ABS(  Period  )  THEN 
Time;*  RealMOD(  Time, Period  ); 

IF  ABS(Alpha-l.O)  >  Small  THEN 
XOld  ;*  Time  *  Alpha 
ELSE 

{  -  lat  guess  can't  be  too  close,  ie  a  circle,  r*a  -  } 
XOld;*  Tirae*Alpha*0.97; 

END 

ELSE 

{ -  Parabola  - } 

IF  ABS(  Alpha  )  <  Small  THEN 
BEGIN 

S;=  0.5  *  (HalfPi  -  ARCTAN(  3.0*8QRT(  1.0/POWBR(Ro[41,3. 
W; =  ARCTAN{  POWER!  TAN(  S  )  ,1. 0/3.0  )  ); 

XOld  ;=  S0RT(Ro[4])*(  2.0*COT(2.0*W)  ); 

Alpha:*  0.0; 

END 

ELSE 

{ -  Hyperbola  - } 

BEGIN 

Temp;*  -2.0*Time  / 

(  A*(  RDotV  +  8GN(Tima)*SQRT(-A)*(l.0-Ro[4)/a) 
XOld;*  SGN(  Time  )  *  SQRT(  -A  )  *  Ln(  Temp  ); 

END; 


); 


Extended; 


)*  Time  )  ); 


)  ); 


{ 


} 


i:=  1; 

WHILE  (  ABS(  TlmeNew-Time  )  >  0.000001  )  and  (  1  <=  15  )  DO 
BEGIN 

XOldSqrd  :=  XOld* XOld; 

ZNew  t-  XOldSqrd  *  Alpha; 

{ - Find  C  and  S  function* - } 

FindCandS(  ZNaw,  CNaw,SNaw  ); 

{  -  Uia  a  Nawton  ltaration  for  ntv  valuaa  -  } 

TlmeNew  :=  X01dSqrd*X01d*8New  +  RDotV*X01d8qrd*CN*w  + 
RoI41*X01d*f  1.0  -  ZNaw*8Maw  It 
DeltaT  ;=  X01dSqrd*CNaw  +  RDotV*X01d*(  1.0  -  ZNew*SNew  )  + 
Ro[4]*(  1.0  -  ZNew*CNew  ); 

{ -  Calculata  naw  valua  for  x  - } 

XNaw  i  =  XOld  +  (  Ti**-Tlm*New  )  /  DaltaT; 


I  Check  If  the  orbit  li  an  elllpae  and  xnaw  >  2pl  SQRT(a),  the  atap 
I  alza  must  ba  changed.  thla  la  accoapllshed  by  Multiplying  DaltaT 

I  by  10.0.  NOTE  II  10.0  la  arbitrary,  but  seeaw  to  produca  good 

I  result*.  The  Idea  la  to  keep  XNaw  froai  increasing  too  rapldlly. 


IP  (  A  >  0.0  )  and  (  AB8(XNew)>TwoPl*SQRT(A)  )  and  {  SHE  <  0.0  )  THEN 
XNaw  l«  XOld  +  (  Ylaw-TlawNaw  )  /  (  Deltr.T*10.0  ); 

{}  IP  Show  =  • Y •  THEN 

{}  Wrltaln(  i«2,X01d»10«5, '  '  ,Tii*aNawil0i5, 1  '  ,DaltaT»10i5, '  ', 

{}  XN*wilO;5,8N*wtlOt5,CH*wtlOi5,inewilOi5  ); 

{}  IP  Show  =  ’S'  THEM 

{}  Wrltaln(  FllaOut,li2,XOldil0i5, •  *, TlmaNaw 1 10:5, '  ' , DaltaT; 10 ;5, '  • , 

{)  XNawil0tS,8Mswil0iS,CNawtl0tS,xnawtl0iS  ); 

Inc(  1  ); 

XOld  <-  XNaw; 

END;  {  While  finding  Unlveraal  Variables  } 

IF  1  >=  15  THEN 

WrlteLn(  1  Not  converged  in  15  Iterations  '  ) 

ELSE 

BEGIN 

{  —  Calculate  position  and  velocity  vector*  at  new  time  -  } 

XNewSqrd  1=  XM«V*XN*W; 

P  i=  1.0  -  (  XNaw8qrd*CNaw  /  Ro[4)  ); 

G  !=  Time  -  XN*wSqrd*XNaw*8N*w; 

POR  lt=  1  to  3  DO 

R[ 1 ] Is  P*Ro[ 1 ]  +  G*Vo[ 1 ) l 
HAG(  R  )> 

GDot  «=  1.0  -  (  XNewSqrd*CNew  /  R[4)  ); 

PDot  t=  (  XNew  /  (  RO[4]*R(4]  )  )  *  (  ZNew*8Hew  -  1.0  ); 

POR  ii-  1  to  3  DO 

V[l)i=  FDot*R0[l]  +  GDot*Vo( 1 ] ; 

HAG(  V  ); 

END; 

END;  {  Procedure  Kepler  } 


PROCEDURE  GAUSS 


This  procedure  solves  tha  Gauss  problem  of  orbit  determination  and  returns 
the  velocity  vectors  at  each  of  two  given  position  vectors.  The  solution 
uses  Universal  Variables  for  calculation  and  a  blssectlon  technique  for 
updating  Z.  This  method  is  slower  than  the  Newton  Iteration  discussed  in 
BMW/  but  it  does  NOT  suffer  problems  with  negative  a  values,  and  is  valid 
for  ellipses  LESS  THAN  one  revolution,  parabolas,  and  Hyperbolas.  Also 
note  the  selection  of  small  since  the  algorithm  is  very  sensitive  to 
changes  in  this  variable.  A  value  of  0.001  will  converge  in  say  10 
iterations  Instead  of  25  iterations  for  a  value  of  0.000001,  and  the 
accuracy  will  differ  in  the  3rd-4th  decimal  place.  I  chose  to  keep  the 
higher  accuracy  for  cases  like  example  13,  BMW  pg.  274,  #5.10. 

(  Refer  to  graph  on  BMW  pg.  235  for  ranges  of  s.  ) 


Algorithm  t  initialize  variables  and  setup  initial  guesses 
Loop  while  the  time  has  not  converged 
If  too  many  iterations,  print  an  error 
otherwise  calculate  the  answer 


Author  i  Capt  Dave  Vallado  USAPA/DPAS  719-472-4109  12  Aug  1988 


Inputs  : 


R1 

-  IJK  Position 

vector 

1 

DU 

R2 

-  IJK  Position 

vector 

2 

DU 

DM 

-  direction  of 

sot  ion 

'L','8' 

Time 

-  Tlmo  between 

HI  and 

R2 

TU 

Outputs 

VI 

» 

-  IJK  Velocity 

vector 

DU  /  TU 

V2 

-  IJK  Velocity 

vector 

DU  /  TU 

Locals 

VarA 

Y 

Upper 

Lower 

CosDeltaNu 

F 

G 

GDot 

YOld 

XOldCubed 

ZOld 

ZNew 

CNew 

SNOW 

TimeNew 

Small 

1 

j 


-  Variable  of  the  iteration,  NOT  the  semi  major  axis! 

-  Upper  bound  for  Z 

-  Lower  bound  for  Z 

-  Cosine  of  true  anomaly  change  rad 

-  f  expression 

-  g  expression 

-  g  dot  expression 

-  Old  Universal  Variable  X 

-  XOld  cubed 

-  New  value  of  % 

-  Hew  value  of  a 

-  C(z)  function 

-  3(a)  function 

-  New  time  TU 

-  Tolerance  for  roundoff  errors 

-  index 

-  index 


Constants  i 

TwoPl 

Small  -  Tolerance  for  roundoff  errors 


Coupling 

HAG 

DOT 

FindCandS 


Magnitude  of  a  vector 
Dot  product  of  two  vectors 
Find  C  and  S  functions 


References 

BMW 


pg.  228-241  (Uses  a  Newton  iteration) 


} 

PROCEDURE  GAUSS 


(  R1,R2  t  Vector ; 

DM  >  Chart 

Time  t  Extended) 

VAR  VI, V2  :  Vector  )t 

CONST 

TvoPi  j  Extended  =  6.28318530717959) 

Small  t  Extended  =  0.000001) 

VAR 

VarA,  Y,  Upper,  Dower,  CosDeltaNu,  t,  G,  GDot,  XOld,  xoidCubed, 

ZOld,  ZNew,  CNew,  SNew,  TlmeNew  >  Extended; 
i,  j  t  Integer; 

BEGIN 

{  -  initialise  values  -  } 

TimeNev;=  -10.0; 

MAG(Rl); 

MAG(R2) ) 

FOR  ii=  1  to  4  DO 
BEGIN 

Vl(i]i=  0.0; 

V2( l]s=  0.0; 

END; 

CosDeltaNut=  DOT(Rl,R2)/(Rl( 4]*R2( 4 1 ) ) 

IF  Dm  =  'L'  THEN 

VarA  ;=  -SQRT<  Rl(4]*R2t4]*(1.0+CoiDeltaNu)  ) 

ELSE 

VarA  ;  =  SQRT(  Rl[4]*R2[4J*(1.0+CosDeltaNu)  ); 

{ -  For*  Initial  guesses  - } 

ZOld  l=  0.0; 

CNew  :=  0.5; 

SNew  :  =  1. 0/6.0; 

Upper i =  TwoPi«TwoPl;  {  Bounds  for  Z  iteration  } 

Lower i =  -2.0*TwoPi; 

{ -  Determine  if  the  orbit  is  possible  at  all - } 

IF  ABS<  VarA  )  >  Small  THEN 
BEGIN 

{  - 

I  Perform  Gaussian  Iteration  using  Universal  Variables.  Notice 
I  the  iteration  is  performed  using  a  bissectlon  technique  Instead  of 
I  a  Newton  ltertlon.  Although  the  Newton  Iteration  is  quicker,  the 
I  bissectlon  will  not  fail  with  large  negative  Z  values.  The  upper 

!  and  lower  bounds  are  adjusted  as  required  to  keep  y  fro*  becoming 

j  negative. 


{ 


END; 


i;  =  0) 

WHILE  (  ABS(  TimeNew-Tlme  )  >  Small  )  and  (  1  <=30  )  DO 
BEGIN 

Y;  =  Rl( 4 ]  +  R2[4]  -  (  VarA*(1.0-Z01d*8New)/8QRT(CNew)  ); 


A  check  Is  needed  for  special  cases  where  VarA  Is  greater  than  0.0. 
It's  possible  that  Z  can  become  very  negative,  and  cause  the  square 
root  In  the  XOld  calculation  to  blow  up.  This  section  loops  and 
adjusts  the  upper  and  lower  bounds  until  the  ZMev  value  will 
result  in  a  +  y  value.  The  solution  is  to  slowly  update  the  lower 
bound  of  Z  until  y  is  +.  The  0.8*  for  ZNew  is  siaply  a  means  to  let 
Z  change  a  little  slower.  The  ZNew  equation  is  found  by  solving  the 
y  equation  for  z  whan  y  =  0. 


IP  (  VarA  >  0.0  )  and  (  Y  <  0.0  )  THEN 
BEGIN 
jl=  1( 

WHILE  (  Y  <  0.0  )  and  (  j  <  10  )  DO 
BEGIN 

ZNewi=  0,8*(1.0/SNew)*(  1.0,-  (Rl[4]+R2[4) )*SQRT(CNew)/VarA  )> 

- Find  C  and  S  functions - } 

PindCand8(  ZNew,  CNev,SNaw  ); 

Z01di=  ZNew; 

Lower t =  ZOld; 

Yt=  Rl[4]  +  R2(4]  -  (  Var A* { 1 . 0-Z01d*8New ) /SORT ( CNew )  ); 

INC(  j  ); 

END; 

IP  j  >=  10  THEN 

WrlteLn{  'The  Iterations  failed  for  Yn  in  GAUSS'  ); 

Earn; 

XOld  s=  SQRT(  Y/CNew  ); 

XOldCubed  t  =  X01d*X01d*X01d ; 

TlmeNew  »=  X01dCubed*8New  +  VarA*SQRT(Y); 

-  Readjust  upper  and  lower  bounds  -  } 

IP  TlmeNew  <  Ties  THEN 
Lower i a  ZOld; 

IP  TlmeNew  >  Time  THEM 
Upper i=  ZOld; 

ZNew; =  {  Upper+Lower  )  /  2.0; 

IF  Show  =  'Y'  THEN 

Writelnf  1  ;2,Z01d;10;5,Y;10t5,X01d;10i5,TlMNew;10;5,VarA;7;3,upper;9;5,lower 
IP  Show  *  'S'  THEN 

Wrltelnl  PileOut,i;2,Z01d;10i5,Yt 10 ; S, XOld; 10 ; S, TlmeNew; 10 iS, VarA; 7; 3, upper; 9 

- Find  C  and  8  functions - } 

PindCandS(  ZNew,  CNev,8Nev  ); 

ZOld  ;=  ZNew; 

Inc(  i  ); 

-  Make  sure  the  first  guess  isn't  too  close - } 

IP  (  ABS(  TlmeNew  -  Time  )  <  Small  )  and  {  1  =  1  )  THEN 
TimeNew;=  -10.0; 

END;  {  While  loop  ) 

IF  i  >=  30  THEN 

Write(  'Gauss  not  converged  in  30  iterations  '  ) 

ELSE 

BEGIN 

-  Use  F  and  G  series  to  find  Velocity  Vectors  - } 

F  ;=  1.0  -  (  Y  /  R1 t 4 J  ); 

G  ;=  VarA*SQRT(  Y  ); 

GDot  ;=  1.0  -  Y/R2[ 4] ; 

FOR  l:=  1  to  3  DO 
BEGIN 

V1[1J;=  (  R2( 1 ]  -  P*R1[ 1 ]  )/G; 

V2C l] *=  (  GDot*R2( i )  -  Rill)  )/G; 

END; 

HAG(  VI  ); 

MAG(  V2  ); 

END;  {  If  the  answer  has  converged  } 

END  (  if  var  a  f  0.0  } 

ELSE 

WrlteLn(  '  Gauss  problem  cannot  be  solved  '  ); 

(  Procedure  Gauss  } 


{ 


PROCEDURE  IJXtoLATLON 


This  procedure 
latitude  and 

Algorithm 


Author 

Inputs 

R 

JD 

OutFuts 

GeoCnLat 

ton 

Locals 

Rc 

Haight 

Alpha 

OldDelta 

DaltaLat 

GaoDtLat 

TwoFHlnusP2 

OnaKlnusF2 

Delta 

RSqrd 

SlnTemp 

Temp 

GST 

l 

Constants 

Pi 

TwoPl 

Flat 

Small 

Coupling 

HAG 

Atan2 

Power 

ArcSin 

GSTlme 

RealHOD 

References 

Escobal 


converts  a  Gaocentric  Equatorial  (IJK)  position  vector  into 
longitude.  Geodetic  and  Geocentric  latitude  are  found. 

Initialise  variables 

Find  the  longitude  being  careful  to  reslove  the  angle 

Setup  iteration  for  latitude 

Loop  while  the  deltas  are  not  equal 

Write  an  error  eessage  it  the  values  do  not  converge 

;  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  18  Sep  1990 


IJK  position  vector  DU 

Julian  Date  days  from  4713  B.C. 


Geocentric  Latitude 
Longitude  (WIST  -) 


-Pi  to  Pi  rad 
-2P1  to  2P1  rad 


Range  of  site  w.r.t.  earth  center  DU 

Height  above  earth  w.r.t.  site  DU 

Angle  fro*  I  axis  to  point,  LST  rad 

Previous  value  of  DeltaLat  rad 

Dift  between  Delta  and  Geocentric  lat  rad 
Geodetic  Latitude  rad 

2*F  -  f  squared 
(  1  -  F  )  squared 

Declination  angle  of  R  in  IJK  system  rad 
Magnitude  of  r  squared  DU2 

Sine  of  Temp  rad 

Diff  between  Geocentric/Ceodetlc  lat  rad 
Greenwich  8ideraal  time  rad 

index 


Flatenning  of  the  Earth 
Tolerance 


Magnitude  of  a  vector 

Arc  Tangent  which  also  resolves  quadrant 

Raises  a  value  to  some  power 

Arc  Sine  of  a  value 

Greenwich  Sidereal  Time 

Extended  MOD  function 


pg.  398-399 


} 


} 

PROCEDURE  IJXtoLatLon 


(  R  i  Vecto r; 

JD  i  Extended; 

VAR  GeoCnLat,Lon  s  Extended  ); 

CONST 

Pi  t  Extended  =  3.14159265358979; 

TwoPi  t  Extended  =  6.28318530717959; 

Small  ;  Extended  =  0.000001; 

Flat  s  Extended  =  0.003352810664747352; 

VAR 

Ro,  Height,  Alpha,  OldDelta,  DeltaLnt,  GeoDtLat,  TvoFHlnusF2,  RSqrd, 
OneHinu«F2,  Delta,  SinTeap,  Tamp,  GST  t  Extended; 
i  <  Integer; 

BEGIN 

{  -  Initialise  values  -  } 

HAG{  R  ); 

TwoFMlnufF2i=  2.0‘Flat  -  Flat*Flat; 

OneMlnusF2  ;=  PO«ER(  ’.0-Flat, 2.0  ); 

{ - Find  longitude  value  - } 

Temp  i=  SQRT{  R[1]*R[1]  +  R[2]*R[2]  ); 

Alpha i =  ATan2(  R[ 2 )  /  Temp  ,  R[l]  /  Temp  ); 

GST  l=  GSTIHB(  JD  ); 

Lon  ;=  Alpha  -  GST; 

IF  ABS(Lon)  >=  Pi  THEN 
IF  Lon  <  0.0  THEN 
Loni=  TwoPi  +  Lon 
ELSE 

Lon;=  Lon  -  TwoPi; 

{  -  Set  up  initial  latitude  value  -  } 

Delta  i=  ArcTan(  R(3]  /  Temp  ); 

IF  ABS(  Delta  )  >  Pi  THEN 

Delta i =  RealHCD(  Delta, Pi  ); 

GeoCnLatia  Delta; 

OldDelta 1.0; 

DeltaLati=  10.0; 

RSqrd  i=  Rl4]*R[4); 

{  -  Iterate  to  find  Geocentric  and  Geodetic  Latitude  -  } 

1;=  1; 

WHILE  (  ABS(  OldDelta  -  DeltaLat  )  >  0.00001  )  and  (  1  <  10  )  DO 
BEGIN 

01dDelta<=  DeltaLat; 

RC  1=  SQRT(  (  1 . 0-TuoFMinUeF2  )  / 

(  1 , 0-TeolM lnue F2*C0S ( GeoCnLa t ) *C08 ( GeoCnLa t )  )  ); 
GeoDtLat  ;=  ArcTan(  TAN ( GeoCnLa t)  /  OneMlnuaF2  ); 

Temp  i=  GeoDtLat-GeoCnLat; 

SlnTemp  i*  SIN(  Temp  ); 

Height  «=  SQRT(  RSqrd  -  Rc*Rc*8inTemp*SlnTeap  )  -  Rc*COS(Te«p)j 
DeltaLat  t  =  ARC8IN(  Helght*SinTemp  /  R[4)  ); 

GeoCnLat  ;=  Delta  -  DeltaLat; 

INC(  1  ); 

END;  {  While  ) 

IP  1  >=  10  THEN 

WrlteLn(  'iJKtoLa'  .  'n  did  NOT  converge  1  ); 

END;  {  Procedure  lJKtoL..Lon  } 


{ 


PROCEDURE  SUM 


This  procedure  calculates  the  Geocentric  Equatorial  position  vector  for 
the  Sun  given  the  Julian  Date.  This  is  the  lo?  precision  formula  and 
is  valid  for  years  from  1950  to  2050.  Accuaracy  of  apparent  coordinates 
is  0.01  degrees.  Notice  many  of  the  calculations  are  performed  in 
degrees,  and  are  not  changed  until  later.  This  is  due  to  the  fact  that 
the  Almanac  uses  degrees  exclusively  in  their  formulations. 

Algorithm  :  Calculate  the  several  values  needed  to  find  the  vector 
Be  careful  of  quadrant  checks 

Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  25  Aug  1988 

Inputs  : 

JD  -  Julian  Date  days  from  4713  B.C. 

Outputs  $ 

RSun  -  IJK  Position  vector  of  the  Sun  AU 

RtAsc  -  Right  Ascension  rad 

Decl  -  Declination  rad 

Locals  : 

MeanLong  -  Mean  Longitude 

MeanAnomaly  -  Mean  anomaly 

N  -  Number  of  days  from  1  Jan  2000 

EclpLong  -  Ecliptic  longitude 

Obliquity  -  Mean  Obliquity  of  the  Ecliptic 

Constants  t 

Pi 

TwoPi 

Rad  -  Degrees  per  radian 

Coupling  : 

RealMOD  Extended  MOD  function 

ArcSin  Arc  81ne  function 

References  i 

1987  Astronomical  Almanac  Pg.  C24 


} 

PROCEDURE  3un 


i  Extended; 

;  Vactor; 

>  Extandad  ); 


(  JD 

VAR  RSun 
VAR  RtAsc »Decl 

CONST 

Pi  i  Extended  2  3.14159265358979; 

TwoPi  s  Extended  2  6.28318530717959; 

Rad  :  Extended  =  57.29577951308230; 

VAR 

MeanLong,  MeanAnomaly,  BclpLong,  Obliquity.  H  :  Extended; 

BEGIN 

{  -  Initialise  values  -  } 

Ni=  (  JD  -  2451545.0  ); 

MeanIiOngi=  280.460  +  0.9856474*N; 

HeanLong;2  RealMOD(  HeanLong, 360.0  );  {deg} 

MeanAnomalyt=  357.528  +  0.9856003*N; 

MeanAnomaly ;  =  RealMOD(  MeanAnomaly/Rad, TwoPi  );  {rad} 

IP  MeanAnomaly  <0.0  THEN 

MeanAnomaly; 2  TwoPi  +  MeanAnomaly; 

EclpLong;2  HeanLong  +  1.915*sin(MeanAnonialy)  +  0.020*sln(2.0*MeanAnooaly) ;  {deg} 
Obliquity;1  23.439  -  0.0000004*N;  {deg} 

MeanLong  ;  =  MeanLong/Rad; 

IP  HeanLong  <0.0  THEN 

MeanLong ;=  TwoPi  +  HeanLong; 

BclpLong  ;  =  BclpLong  /  Rad; 

Obliquity;2  Obliquity  /  Rad; 

RtAsc;2  ARCTAN(  Cos(Obliquity)*Tan(EclpLong)  ); 

{ - Check  that  RtAac  la  in  the  same  quadrant  as  BclpLong  —  } 

IP  BclpLong  <0.0  THEN 

BclpLong;2  BclpLong  +  TwoPi;  {  aake  sure  it's  in  0  to  2pl  range  } 

IP  ABS(  EclpLong-RtAsc  )  >  Pi/2.0  THEN 

RtAsc; 2  RtAsc  4-  0.5*Pl«ROUMD(  (EclpLong-RtAec)/(0.5*Pi)  ); 

Decl  ;=  ARCSIN(  3in(0bllqulty)*8in(EclpLong)  ); 

{  -  Find  magnitude  of  SUM  vector,  then  component*  -  } 

RSun[ 4] ;2  1.00014  -  0.01671*Cos(  MeanAnomaly  ) 

-  0.00014*Cos(  2.0*MeanAno*aly  );  {  in  AU'a  } 

RSun( 1  ] ;=  RSun[ 4]*Cos(  BclpLong  ); 

RSun[2};2  RSun[ 4]  *Co» (Obliquity )*8in( BclpLong); 

RSun( 3 ] ;=  R8un[ 4 ]*Sin (Obliquity )*8in (BclpLong) ; 

END;  {  Procedure  Sun  } 


{ 


PROCEDURE  MOON 


This  procedure  calculates  the  Geocentric  Equatorial  (IJK)  position  vector 
for  the  moon  given  the  Julian  Date.  This  is  the  low  precision  formula  and 
is  valid  for  years  between  1950  and  2050.  Notice  many  of  the  calculations 
are  performed  in  degrees.  This  coincides  with  the  development  in  the 
Almanac.  A  few  equations  were  split  in  two  to  prevent  software  problems 
with  numeric  coprocessors.  The  errors  seemed  to  be  a  stack  overflow  problem 
since  the  equation  is  so  long.  The  prograsi  results  are  as  follows: 

Bclpltlc  Longitude  0.3  degrees 

Eclpitlc  Latitude  0.2  degrees 

Horls  Parallax  0.003  degrees 

Distance  from  Barth  0.2  DOS 

Right  Ascension  0.3  degrees 

Declination  0.2  degrees 


Algorithm  »  Find  the  initial  quantities 
Calculate  direction  cosines 
Find  the  position  end  velocity  vector 


Author 

l 

Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  25  Aug  1988 

Inputs 

X 

JD 

Julian  Date 

days  from  4713  B.C. 

Outputs 

t 

RMoon 

- 

IJK  Position  vector  of  the  Moon 

DU 

RtAsc 

- 

Right  Ascension 

rad 

Decl 

~ 

Declination 

rad 

Locals 

X 

EclpLong 

- 

Bcllptlc  Longitude 

EclpLat 

- 

Bclpltlc  Latitude 

HzParal 

- 

Horizontal  Parallax 

1 

m 

Geocentric  Direction  Cosines 
«  ■ 

n 

Tu 

•  • 

Julian  Centuries  from  1  Jan  1900 

X 

- 

Temporary  RIAL  variable 

Constants 

l 

TwoPl 

- 

6.28318530717959 

Rad 

* 

Degrees  per  radian 

57.29577951308230 

Coupling 

l 

RealMOD 

Real  MOD  function 

ArcSin 

Arc  Sine  function 

Atan2 

Arc  Tangent  formula  which  resolves  quadrants 

References 

X 

1987  Astronomical  Almanac  Pg.  D46 

Explanatory  Supplement!  1960  )  pg.  106-111 

Roy,  Orbital  Motion  Pg.  61-62  (  Discussion  of  parallaxes  ) 


} 


} 

PROCEDURE  Moon 


t  Extended; 
t  Vector; 
t  Extended  ) ; 


(  JD 

VAR  RMOon 
VAR  RtAsC.Decl 

CONST 

TwoPi  <  Extended  =  6.28318530717959; 

Rad  i  Extended  =  57.29577951308230; 

VAR 

EclpLong,  EclpLat,  HzParal,  l,ra,n,Tu,x  i  Extended; 

BEGIN 

{  -  Initialise  values  -  } 

Tu  !=  (  JD  -  2451545.0  )  /  36525.0; 


x  «=  218.32  +  481267. 883+Tu 

+  6.29*Sln(  (134. 9+477198. 85*Tu)/Rad  ) 

-  1.27*Sin(  (259. 2-413335. 38*Tu)/Red  ) 

+  0.66*Sln(  (235.7+890534. 23*Tu)/Rad  ); 

EclpLong i =  x  +  0.21*Sin{  (269. 9+954397. 70*Tu)/Rad  ) 

-  0.19*Sln(  (357.5+  35999. 05*Tu)/Rad  ) 

-  0.11*Sln(  (186. 6+966404. 05*Tu)/Rad  ); 


{  Deg  } 


EclpLat  i=  5.13*Sin(  (  93. 3+483202. 03*Tti)/Rad  ) 

+  0.28*Sln(  (228. 2+960400. 87*Tu)/Rad  ) 

-  0.28*8ln(  (318.3+  6003.18*Tu)/Rad  ) 

-  0.17*Sln(  (217. 6-407332. 20*Tu)/Rad  ); 


{  Deg  } 


X  !  = 


0.9508  +  0.0518*Cos(  (134. 9+477198. 85*Tu)/Rad  ); 


HzParal  i=  x  +  0.0095*Cos(  (259. 2-413335. 36*Tu)/Rad  ) 

+  0.0078*Cos(  (235. 7+890534. 23+Tu)/Rad  ) 

+  0.0028*Cos{  (269. 9+954397. 70+Tu)/Rad  ); 


{  Deg  } 


EclpLong  i=  RealM0D(  BclpLong/Rad,  TwoPi  ); 

EclpLat  t=  RealMOD(  sclpLat/Rad,  TwoPi  ); 

HzParal  «*  RealMODj  HzParal/Rad,  TwoPi  ); 

{  -  Find  the  geocentric  direction  cosines  -  } 

li=  C0S(  EclpLat  )  *  Cos (  EclpLong  ); 

0.9175*Co*(BclpLat)*Sln(EclpLong)  -  0.3978*81n(EclpLat); 
m=  0 . 397  6*Cos  ( EclpLat } *8 In ( EclpLong )  +  0. 9175*Sln(  EclpLat ) ; 


{ - Calculate  Moon  position  vector - } 

RMoon(4] i=  1.0/SIN(  HzParal  ); 

RMoon [ 1 ] i =  RMoon(4)*l; 

RHoon(2] :=  RMoon[4]*m; 

RHoont  3 j i=  RMoon{4]*n; 


{  -  Find  Rt  Ascension  and  Declination  -  } 

RtAsct-  ATan2(  m,l  ); 

Decl:=  ArcSlnf  n  ); 

END;  {  Procedure  Moon  } 


{ 


} 

{ - 

I 

I  PROCEDURE  PLANET RV 

I 

I  This  procedure  calculate  the  planetary  ephenerides  using  the  Epoch  J2000. 

I  The  coefficients  are  obtained  from  Danbys  book  and  provisions  are  left 
I  to  obtain  Heliocentric  Equatorial/  or  Heliocentric  Ecliptic  coordinates. 

I  Notice  the  ephemeris  presents  data  vrt  the  solar  equator. 

I  Algorithm  s  Use  a  case  statement  to  assign  each  planets  values 
j  Find  the  vectors 

I 

!  Author  s  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  4  Feb  1990 

I  Inputs  : 

j  PlanetNum  -  Number  of  planet  1..9 

i  JD  -  Julian  Date  days  from  4713  B.C. 

1  Outputs  i 

I  R  -  XX 7.  position  vector  AU 

I  V  -  XTZ  velocity  vector  ku  /  TU 

I  Locals  i 

I  u 

I  1 

I  cappi 

j  TU 

i  N 

I  obliquity 

I  a 

i  e 

I  p 

I  Inc 

I  omega 

I  argp 

I  nu 

I  m 

i  LLong 

I  LongP 

I  eO 

I 

I  Constants  : 

S  TvoPi 

I  Rad  -  Degrees  per  radian 

I  Coupling  i 

I  RealHOD 

I  NewtonR 

I  RandV 

I 

I  References  i 

1  Danby  pg.  427-429 

I  Escobal{2)  pg.  261-270 

!  Astronomical  Almanac  pg  E2-B4 

-  } 


PROCEDURE  PlanetRV  (  PlanetNum  t  Integer; 

JD  i  Extended; 

VAR  R,V  i  Vector  ); 

CONST 

TvoPi  i  Extended  =  6.28318530717969; 

Rad  ;  Extended  =  57.29577951308230; 

VAR 

TUDaySun, u,l, cappi, Tu,n, obi lqulty, a, e,p, Inc, omega, argp, nu, 
llong, longp,m,e0  t  Extended; 

i  i  Integer; 

BEGIN 

Tu  i=  i  JD  -  2451545.0  )  /  36525.0; 


} 


CASE  PlanetNum  OP 

It  BEGIN  {  - 

LongPi3 
Omegat3 
Inc  i  = 
e  1= 
LLong := 
a  1  = 

END) 


2i 


END) 

3:  BEGIN  {  - 
LongPi3 

Omsgai = 
Inc  t  = 
a  !  3 
LLong t 3 
a  »  = 
END) 

4 1  BEGIN  {  - 
LongPi3 
Omega i 3 
Inc  i  = 
a  i  = 
LLong  t - 

a  t  = 
END) 

5 1  BEGIN  {  - 
LongPi= 


- Mercury - } 

1.3518643  +  0.0271656*Tu 
C. 8435332  +  0.0207029*Tu 
0.1222601  +  0.0000318*Tu 
0.2056318  +  0.0000204*Tu 
4.4026098  +2608.8147071*Tu 
0.3871035) 


BIN  { - 

- Venus 

- } 

LongPi = 

2.2962199  + 

0.0244734*Tu  - 

Omegat3 

1.3383171  + 

0.0157275*Tu  + 

Inc  := 

0.0592480  +■ 

0,0000175*Tu  - 

e  i  = 

0.0067719  - 

0.0000478*TU) 

LLong 
a  :  = 

3.1761467  +1021.3529430*Tu  + 
0.7233074) 

- Earth 

1.7965956  * 
0.0000000) 
0.0000000) 
0.0167086  - 
17.4614336  + 
1.0000116; 


-) 


0.0300116*Tu  + 


0.0000420*Tu) 
628. 3319667*Tu  + 


- Mar* 

5.8653576  + 
0.8649519  + 
0.0322838  - 
0.0934006  + 
6.2034809  + 
1.5237107) 


-} 


0.0321323*Tu 

0.0134756*Tu 

0.0000105‘Tu 

0.0000905‘Tu 

334.0856279*Tu 


- Jupiter - } 

6.5333138  +  0.0281458*Tu  + 


Omegat3 
Inc  i  = 
a  i  = 
LLong i 3 
a  i* 
END) 

6 1  BEGIN  { 
LongPi= 


1.7534353  + 
0.0227464  - 
0.0484949  + 
0.5995465  * 
5.2102156) 

- Saturn 

1.6241473  + 


0.0178190*Tu  + 
0.0000959*Tu  + 
0.0001632*Tu  - 
52.9934808*Tu  + 


- } 

0.0342741*Tu  + 
+ 


Omegat3  1.9838376  +  0.0153082*Tu  - 


{ 


Inc  i  = 

a  :  = 

LLong i » 
a  i  = 

END) 

7)  BEGIN  { 
LongPi= 
Omega i = 

Inc  i  = 

e  i  = 

LLong t 3 
a  :  = 

END) 

8 i  BEGIN  { 

LongPi= 
Omega i= 
Inc  i  = 

o  i  = 

LLong i = 
a  i  = 

END) 

9 i  BEGIN  { 

LongPi = 
Omegat3 
Inc  i  = 

e  i  = 

LLong i 3 
a  i  = 

END) 

END)  {  Case  } 


0.0434391  - 
0.0555086  - 
0.8740168  + 
9.5380701) 


3.0195096  + 
1.2916474  + 

0.0134948  + 
0.0462959  - 
5.4812939  + 
19.1833020) 


0.8399169  + 
2.3000657  + 
0.0308915  - 
0.0089881  + 
5.3118863  + 
30.0551440) 


3.9202678) 

1.9269569) 

0.2990156) 

0.2508770) 

3.8203049) 

39.5375800) 


0.0000652*TU  - 
0.0003468*Tu  - 
21 . 3542956*Tu  + 


- } 

0.0259422*Tu  + 
0.0090954*Tu  + 
+ 

0.0000135*TU  + 
0.0000273*Tu  + 
7.5025431*TU 


- } 

0.0248931*Tu  + 
0.0192371*Tu  + 
0.0001625*Tu  - 
0.0000064*TU) 
3.8376877*Tu  + 


) 


'Uranus 


•Neptune 


■Pluto 


0.000005166*Tu*Tu) 
0.000003072*Tu‘Tu) 
0 . 000000314*Tu*TU) 
0.000000030*Tu*Tu) 
0. 000005306 *Tu*Tu) 


0.000018727*Tu*Tu 
0 . 000000087*Tu*Tu*Tu> 
0.000007103*TU*TU) 

0 . 000000017*Tu*Tu ) 

0,000005 4 28*Tu*TU) 


0.000008029*Tu*Ta) 


0.000005306*Tu*Tu) 


0 . 000000236 *Tu*TU) 
0.000000279*Tu*Tu) 
0. 000000227 *Tu*Tu) 
0 .000000080*Tu*Tu) 
0.000005428*Tu*TU) 


0.000017994*Tu*Tu 

0.000000070*Tu*Tu*Tut 

0.000006999*Tu*Tu) 

0.000000087*TU*TU) 

0.000000470*Tu*Tu) 

0 . 000003910*Tu*Tu ) 


0.000014626*Tu*Tu 
0. 000000087*Tu*Tu*Tu> 
0 . 00000211 2*Tu*Tu 
0 . 000000035*T'J*TU*TU ) 
0.00000026 2*Tu*TU) 
0.000001000*Tu*Tut 
Q.C00009076*Tu*TU) 


0.000003752*Tu*TU) 
0.0000233B7*Tu*TU 
0.000000332*Tu*Tu*Tu) 
0 • 0000006  46*Tu*Tu ) 
0.000000080*Tu*TU) 

0 . 000005306*Tu*Tu | 


0.000006615*'fu*TU) 
0.000004538*Tu*TU) 
0. 0000001 40*Tu*Tu) 

0.000005393*Tu*Tu) 
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LLong:=  REALMOD (  LLong,TwoPI  )> 

LongP:=  REALMOD (  LongP.TwoPI  ) ; 

Omega :=  REALMOD (  Omega, TwoPI  ); 

Argpi=  LongP  -  Omega ; 

M  :=  LLong  -  LongP; 

NewTonR(  e,M,  80,Nu  )> 
p:=  a*(1.0-e*e); 

u  i=  0.0; 

1  «=  0.0; 

Cappi«=  0.0; 

RANDV (  P,e, Inc, Omega, Argp,Nu,U,L,CapPi,  R,V  ); 

Alternate  method  for  finding  poaition  vector 
r [ 4 ] *  =  (  a*(  1.0-e*eJ  )  /  (  l.fl+e*Cos(Nu)  ); 

r[l]s=  r C 4 ] * (  Cos(Nu+Argp)*Cos(Omega)-Sln(Nu+-Argp)*Cos(Inc)*81n(Omega)  ); 
r[2]i=  r [ 4 ) * (  Cos(Nu+Argpj*Sin(0mega)+8in(Nu+Argp)*Cos(Inc)*Cos(0mega)  ); 
r  1 3  J  r  =  r(4 j*Sln(Nu+Argp)*8in(Inc); 


{  -  Calculations  required  for  reference  to  mean  equator  —  } 

N  :=  (  JD  -  2451545.0  ); 

Obliquity Is  23.439  -  0.0000004*N;  {deg} 

Obllqultyi=  Obliquity  /  Rad; 

ROT1 (  R  , -Obliquity,  R  ); 

ROTl(  V  , -Obliquity,  V  ); 

TUDaySum  =  54.20765355;  (  days  per  sun  TU) 

FOR  ll=  1  to  3  DO 

v ( 1 )  t  =  v[ 1 ]/tudaysun; 

IF  Show  =  ‘Y*  THEN 
BEGIN 

WrlteLn(  1  a  e  i  Omega  LongP  '); 

WriteLn(  a:10i6,«il3i6,Inc*radil0i6,Oiaegu»rad:12i6,LongP*radil4i8  ); 
WriteLnj  '  LLong  Argp  M  Nu  '); 

WrlteLn(  LLong*radil4i 5, Argp*radil2i6 ,H*r«dil2 ;6 ,Nu*radi 12 t6  ); 

END; 

END;  {  Procedure  PlanetRV  } 
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FUNCTION  GEOCENTRIC 


This  Function  converts  from  Geodetic  to  Geocentric  latitude.  Notice  that 
(1-f )  squared  =  1-eSgrd. 

Algorithm  :  Find  the  answer 

Author  »  Capt  Dave  Vallado  USAFA/DFA3  719-472-4109  12  Aug  1988 


Inputs 

Lat 


-  Geodetic  Latitude 


Outputs  t 

Geocentric  -  Geocentric  Latitude 

Locals  s 

None. 

Constants  : 

EESqrd  -  Eccentricity  of  Earth  squared. 

Coupling  i 

None. 

References  i 

Escobal  pg.  136 
Kaplan  pg.  332-336 


-Pi/2  -  Pi/2  rad 


-Pi/2  -  Pi/2  rad 


0.00669437999013 


FUNCTION  Geocentric  (  Lat 

CONST 

EESqrd  i  Extended  =  0.00669437999013) 

BEGIN 

Goocentrici=  ARCTAN(  (1.0  -  BESqrd)*TAN(Lat)  )> 
END)  {  Function  Geocentric  } 


>  Extended  ): Extended) 


FUNCTION  INVGE0CKNTR1C 


This  Punctlon  converts  from  Geocentric  to  Geodetic  latitude.  Notice  that 
(1-f)  squared  =  1-eSquared. 


Algorithm 


Inputs 

Lat 


-  Geocentric  Latitude 


Constants 

EESqrd 

Coupling 

None. 


Find  the  answer 

Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  12  Aug  1988 


Outputs  < 

InvGeocentric-  Geodetic  Latitude 


Locals 

None. 


-  Eccentricity  of  Barth  squared 


References  i 
Escobal  pg.  136 
Kaplan  pg.  332-336 


-Pi/2  -  Pl/2  rad 


-Pl/2  -  Pi/2  rad 


0.00669437999013 


FUNCTION  InvGeocentric  (  Lat 

CONST 

EESqrd  i  Extended  =  0.00669437999013) 

BEGIN 

InvGeocentric i-  ARCTAN (  TAN(Lat)/(1.0  -  EESqrd)  )) 
END)  {  Function  InvGeocentric  } 


i  Extended  ) (Extended) 


} 

I  .  ’  " 

I  PROCEDURE  SIGHT 


Thi.'  procedu'.; .  takes  the  position  vectors  of  two  satailltas  and  determines 
if  theca  is  line-of-sight  between  the  two  satellites.  A  spherical  Barth 
with  radius  of  1  DU  is  assuawd.  The  process  ia  to  form  the  aquation  of 
a  line  between  the  two  vectors.  Differentiating  and  setting  to  aero  finds 
the  minimum  value,  and  when  plugged  back  into  the  original  line  equation, 
gives  the  minimum  distance.  The  parameter  tain  is  allowed  to  range  from 
0.0  to  1.0. 


Algorithm  >  Find  tmin 

Check  value  of  tmin  for  LOS 
Find  diet  squared  if  needed 

Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  31  Jan  1990 


Inputs  i 

Rl  -  Position  vector  of  the  first  sat  DU 

R2  -  Position  vector  of  the  second  sat  DU 


Outputs 

LOS 


s 

-  Line  of  Sight 


I  Locals 
1  ADotB 

!  TMln 

I  DlstSqrd 

I  ASqrd 

I  BSqrd 

!  Constants 
!  None. 


< 

-  Dot  product  of  a  dot  b 

-  Minimum  value  of  t  from  a  to  b 

-  Min  Distance  squared  for  to  earth 

-  Magnitude  of  A  squared 

-  Magnitude  of  B  squared 

t 


'Yes’ , 'No  • 


DU 


Coupling! 

DOT  Dot  product  of  two  vectors 

References  i 
None. 


} 


»  Vector i 
t  Str3  )j 


2. 0* ADotB  )) 

IF  (TMln  <  0.0)  or  (TMln  >  1.0)  THEN 
LOSi  =  'YES' 

ELSE 

BEGIN 

DlstSqrd>=  (1 .0-TMin)*ABqrd  +  ADotB*TMin) 

IF  DlstSqrd  >  1.0  THEN 
LOS  Is  'YES' 

ELSE 

LOSj=  'NO  ') 

END; 

END;  {  Procedure  Sight  } 


PROCEDURE  SIGHT  (  R1.R2 

VAR  LOS 

VAR 

ADotB, TMln, DlstSqrd, ASqrd, BSqrd)  EXTENDED) 
BEGIN 

BSqrd i =  R2[4)*R2(4]> 

ASqrd i=  R1[4]»R1[4]| 

ADotB i =  DOT(  R1,R2  )J 

THin  i=  (  ASqrd  -  ADotB  )  /  (  ASqrd  *  BSqrd  - 
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} 

{ 


PROCEDURE  LIGHT 


This  procedure  determines  If  a  spacecraft  la  sunlit  or  in  the  dark  at  a 
particular  time.  A  spherical  Barth  and  cylindrical  shadow  is  assumed. 


Algorithm  i  Find  the  sun  vector 

Use  the  sight  algorithm  for  the  answer 

Author  t  Capt  Dave  Vallado  USAPA/DFAS  719-472-4109  9  Feb  1990 


Inputs  : 

R  -  IJK  Position  vector  of  satellite  DU 

JD  -  Julian  Date  of  desired  observation  Days  from  4713  B.C. 


Outputs 

Vis 


! 

-  Visibility  Flag 


•Fes', 'No  ' 


Locals 

RtAsc 

Decl 

RSun 

AUDU 

Constants 

None 


< 

-  Suns  Right  ascension 

-  Suns  Declination 

-  8un  vector 

-  Conversion  from  AU  to  DU 

t 


rad 

rad 

AU 


Coupling 

SUN 

LNCOMl 

SIGHT 


Position  vector  of  Sun 

Multiple  a  vector  by  a  constant 

Does  Llne-of-sight  exist  bevteen  vectors 


References  t 
Escobal  pg. 


> 


PROCEDURE  LIGHT 

(  R 

i  Vector} 

JD 

t  Extended} 

VAR 

VAR  LIT 

i  Str3 

RSun 

t  Vector} 

AUDU, RtAsc, Decl  i  Extended} 

BEGIN 

AUDU ; *  149S99650.0/6378.137; 

SUN(  JD, RSun, RtAsc, Decl  )} 

LNCOMl (  AUDU, RSun,  RSun  )} 

{ - Is  the  satellite  in  the  shadow? - ) 

SIGHT (  RSun,R,  Lit  )} 

END}  {  Procedure  Light  } 
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} 


PROCEDURE  OMS2 

This  procedure  determines  the  velocity  and  position  vector  of  the  shuttle 
after  it  performs  the  OMS-2  burn.  Assume  the  burn  and  the  resulting 
velocity  change  are  instanteanous. 


Algorithm 

* 

Find  the  velocity  vector 

Rotate  to  IJX 

Author 

: 

Capt  Dave  Vallado  USAFA/DFAS  719-472-4109 

7  Mar  1990 

Inputs 

: 

Lat 

- 

Geodetic  latitude  of  the  shuttle's  Earth  sub- 

point  (its  NADAR)  before  the  burn. 

rad 

Don 

- 

Geodetic  longitude  of  the  shuttle's  NADAR 

rad 

Alt 

- 

Altitude  of  the  shuttle  above  the  Earth's  surface  DU 

Phi 

- 

Shuttle  flight  path  angle 

rad 

Az 

- 

Shuttle  aaimuth  angle 

rad 

Speed 

- 

Shuttle  scalar  velocity  with  respect  to  inertial  space  du/tu 

JD 

- 

Julian  Date 

Ref  4713  B.C. 

Outputs  : 

R 

- 

Position  vector  of  the  shuttle  after  the  OHS2 

burn  DU 

V 

- 

Inertial  velocity  vector  of  the  shuttle  after 

OM82  burn  DU/TU 

Locals 

: 

VSEZ 

- 

Velocity  vector  expressed  in  the  SEZ  frame 

DU/TU 

Constants 

. 

HalfPl 

Coupling 

: 

LSTIME 

- 

Find  LST  and  GST 

SITE 

- 

Find  Site  vector  on  an  oblate  Earth 

R0T2 

- 

Rotate  about  the  2  axis 

ROT  3 

- 

Rotate  about  the  3  axis 

References 

s 

None. 

PROCEDURE  0MS2  (  Lat, Lon, Alt, Phi ,As, Speed, JD  i  Extended; 

VAR  R,V  l  VECTOR  ); 

CONST 

HalfPl  i  Extended  =  1.57079632679490; 

VAR 

GST,  LST  i  Extended; 

VSEZ,VS,TempVec  i  Vector; 

BEGIN 

LSTlme(  Lon, JD,  Lst,Gst  ); 

SITE(  Lat,Alt,Lst,  R, VS  ); 

{  —  Velocity  vector  in  the  rotating,  Barth-fixed  SEZ  frame  —  } 
VSEZ(l)  1=  -Speed  *  COS(Phl)  *  COS(As); 

VSEZ [ 2 ]  )=  Speed  *  COS(Phl)  *  SIN(Az) ) 

VSEZ( 3 ]  t -  Speed  *  SIN(Phi); 

MAG(  VSEZ  ); 

{  -  Perform  SEZ  to  IJK  transformation  -  } 

ROT2(  VSEZ,  Lat-HalfPl,  TempVeo  ); 

ROT3(  TempVec,  -LSI  ,  V  ); 

END)  (  Procedure  ONS2  } 
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}  __ 

I  "  "  ~  ~  . . .  . . . . . 

I  PROCEDURE  RNGAZ 

I 

i  This  procedure  calculates  the  Range  and  Azimuth  between  two  specified 
!  ground  points  on  a  spherical  Earth.  Notice  the  range  will  ALWAYS  be 

I  within  the  range  of  values  listed  since  you  do  not  know  the  direction  of 

i  firing,  long  or  short.  The  procedure  will  calculate  Rotating  Barth  ranges 
j  if  the  TOF  is  passed  in  other  than  0.0. 

I  Algorithm  :  Find  the  range 

j  Calculate  the  As  noting  all  combinations  of  quadrants 


Author 

i  Capt  Dave  Vallado  USAFA/DFAS 

719-472-4109 

25  Aug  1988 

Inputs 

LLat 

-  Start  Geocentric  Latitude 

-Pl/2 

-  Pl/2  rad 

LLon 

-  Start  Longitude  (WEST  -) 

0.0  - 

2Pi  rad 

TLat 

-  End  Geocentric  Latitude 

-Pi/2 

-  Pl/2  rad 

TLon 

-  End  Longitude  (WEST  -) 

0.0  - 

2Pi  rad 

TOF 

-  Time  of  Flight  if  ICBM,  or  0.0 

TU 

Outputs 

Range 

i 

-  Range  between  points 

0.0  - 

Pi  rad 

Az 

-  Azimuth 

0.0  - 

2Pi  rad 

I  Locals  : 

I  None . 

I 

I  Constants  s 

I  TwoPl 

I  Pi 

i  OmegaEarth  -  Angular  rotation  of  Earth  Rad/TU 

I  Small  -  Tolerance 

I 

I  Coupling  i 

I  ArcCos  Arc  Cosine  function 

I 

I  References  : 

i  BMW  pg.  309-311 

- } 

PROCEDURE  RngAz  (  LLat ,LLon,TLat ,TLon,T0F  <  Extended; 

VAR  Range,  As  i  Extended  ) > 

CONST 

OmegaEarth  t  Extended  *  0.0588335906868878) 

Pi  i  Extended  =  3.141592653589791 

TwoPl  i  Extended  =  6.28318530717959) 

Small  t  Extended  »  0.000001) 

BEGIN 

Range i =  ArcCos(  SlN(LLat)*SlN(TLat)  + 

COS(LLat)*COS(TLat)*COS(TLon-LLon  +  OmegaKarth*TOF)  )) 

{ - Check  if  the  Range  is  0  or  half  the  earth  - } 

IF  ABS(  S in ( Range )*Cos( LLat)  )  <  Small  THEN 
IF  ABS(  Range  -  Pi  )  <  Small  THEN 
Azt  =  Pi 
ELSE 
Ax«  =  0.0 

ELSE 

Azt  =  ArcCos (  (  SlN(TLat)  -  COS(Range)  *  8IN(LLat))  / 

(  SlN(Range)  *  COS(LLat))  )) 

{ - Check  if  the  Asimuth  is  grt  than  Pi  (  180deg  ) - } 

IF  SIN(  TLon  -  LLon  +  OmegaBarth‘TOF  )  <  0.0  THEN 
Azi  =  TwoPl  -  Az; 

END)  {  Procedure  RngAz  } 


} 


PROCRDURB  PATH 


This  procedure  determines  the  and  position  foe  a  given  ranga  and  azimuth 
from  a  given  point.  Notice  tha  usa  of  ATAN2  to  eliminate  quadrant 
problama.  Also,  Caocan'tric  coordinates  art  usad  since  the  Barth  is 
assumed  to  be  spherical. 


j  Algorithm 


I  Author 

I  Inputs 
LLat 
Lion 
Range 
AZ 


s  Find  tha  latitude 

Find  tha  change  in  longitude  noting  quadrant  posalbilities 
Calculate  the  longitude 

:  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  25  Aug  1988 


-  Start  Geocentric  Latitude 

-  Start  Longitude 

-  Range  between  points 

-  Azinuth 


-Pl/2  -  Pi/2  rad 
0.0  -  2Pi  rad 
DU 

0.0  -  2Pi  rad 


I  Outputs 
TLat 
TLon 


-  Bnd  Geocentric  Latitude 

-  Bnd  Longitude 


-Pi/2  -  Pi/2  rad 
0.0  -  2Pi  rad 


Locals 

SinDeltaM 

CosDeltaN 

DeltaN 


-  Sine  of  Delta  M 

-  Cosine  of  Delta  N 

-  Angle  bteween  the  two  points 


I  Constants  s 

Pi 

TwoPl 

Small  -  Toleranca 


j  Coupling 
ArcSln 
RealMOD 
Atan2 


Arcsine  function 
Real  HOD  function 

Arc  Tangent  function  which  also  resolves  quadrants 


I  References  : 
BMW  pg.  309-311 
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} 

PROCEDURE  Path 


(  LLat,  LLon,  Rang*,  As 
VAR  TLat,  TLon 

CONST 

Pi  :  Extended  =  3.14159265358979? 

TwoPi?  Extended  =  6.28318530717959? 

Small?  Extended  =  0.000001? 

VAR 

SinDeltaM/CoeDeltaN,  DeltaN  i  Extended? 

BEGIN 

Az?  =  RealHODf  As, TwoPi  )? 

IF  LLon  <  0.0  THEN 

LLon t =  TwoPi  +  LLon? 

IF  Range  >  TwoPi  THEN 

Rang# i =  RealHOD(  Range, TwoPi  )? 

{  -  Find  Geocentric  Latitude  -  } 

TLat  i-  ARC8IN(  SIN(LLat)*COS(Range)  +  COS(LLat)*SIN(Range)*COS(Az)  )? 

{ - Find  Delta  N,  the  angle  between  the  point* - } 

IF  (ABS(COS(TLat) )  >  Small)  and  (ABS(COS(LLat))  >  Small)  THEN 
BEGIN 

SlnD*ltaNi=  SIN(As)*SIN(Range)  /  COS(TLat)? 

Co»DeltaN?=  (  COS { Rang* ) -SIM ( TLat ) *8IN ( LLat )  )  /  (  C08 ( TLat ) *COS ( LLa t )  )? 
D*ltaN?=  ATan2(SinDeltaN,Co#D*ltaN)? 

END 

ELSE 

BEGIN 

{ - Case  where  launch  is  within  3nm  of  a  Pol* - } 

IF  ABS( COS (LLat))  <=  Small  TEEM 

IF  (Rang*  >  Pi)  and  (Rang*  <  TwoPi)  THEN 
DeltaN  t=  As  4-  Pi 
ELSE 

DeltaN t-  As? 

( - Casa  where  end  point  is  within  3na  of  a  pole - } 

IF  ABS(  COS(TLat)  )  <*  Small  THEN 
D*ltaNi=  O.Oj 

END) 

TLon:=  LLon  4-  DeltaN) 

IF  TLon  <  0.0  THEN 

TLon  I  *  TwoPi  4-  TLon) 

IF  TLon  >  TwoPi  THEN 

TLon i “  RealMOD(  TLon, TwoPi  )? 

END)  {  Procedure  Path  } 

{ 


?  Extended? 

?  Extended  )? 
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PROCEDURE  TRW  EC 


This  procedure  calculates  the  Range,  Azimuth,  and  TiM  of  Flight  between 
two  specified  ground  points  for  an  ICBM  with  as  known  Q.  Calculations 
depend  on  knowledge  of  burnout  conditions*  and  the  iterations  are 
perforated  for  either  a  high  or  low  trajectory.  Notice  the  ICBM  will  fly 
oh  an  inertial  trajectory,  and  values  for  earth  relative  velocities, 
etc.,  are  calculated  after  the  iteration.  Notice  these  calculations  do 
not  support  trajectories  over  half  the  world  away. 


Algorithm 


Author 

Inputs 

LLat 

LLon 

TLat 

TLon 

Rbo 

0 

TypePhi 


t  Find  the  Range  and  As  with  0  TOF 
if  the  trajectory  is  possible, 
l>oop  to  find  the  Range  and  As  corrected 
Calculate  Influence  coefficients 
Find  velocity  needed 


Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  9  Oct  1988 


Start  Geocentric  Latitude 
Start  Longitude  (HIST  -) 
End  Geocentric  Latitude 
End  Longitude  (HIST  -) 
Radius  at  burnout 


-Pl/2 
0.0  - 
-Pl/2 
0.0  - 
DU 


-  Pi/2  rad 
2P1  rad 

-  Pl/2  rad 
2Pi  rad 


Non-dimensional  Q  performance  based  on  Inertial  Velocity 
Type  of  trajectory,  High  ot  Low  'H',  'L' 


Outputs 

Range 

Phi 

TOF 

Az 

iCPhl 

ICVbo 

ICRbo 

Vn 


t 

-  Rotating  Range  between  points 

-  Inertial  Flight  Path  Angle 

-  Rotating  tarth  Time  of  Fligth 

-  Inert  Azimuth 

-  influence  Coefficient  for  Phi 

-  Influence  Coefficient  for  Vbo 

-  Influence  Coefficient  for  Rbo 

-  Velocity  the  missile  needs 


Locals 

Small 

QBoKln 

a 

Ecc 

E 

RangeOld 

Vbo 

VEarth 

1 


-  Tolerance 

-  Minimum  Q  for  a  given  range 

-  Semi  Major  Axis 

-  Eccentricity 

-  Eccentric  Anomaly 

-  Iteration  value  of  range 

-  inertial  Velocity 

-  Earths  velocity 

-  Index 


Constants 

Pi 

Rad 

OmegaEarth 

Undefined 


-  Degrees  per  radian 

-  Angular  rotation  of  Barth  (Rad/TU) 

-  Flag  for  an  undefined  element 


0.0  -  Pi  rad 

rad 

TU 

0.0  -  2P1  rad 
rad/rad 
rad/  DU/TU 
rad/rad 
DU/TU 


DU 

rad 

DU 

DU/TU 

DU/TU 


Coupling 

HAG 

ArcSin 

ArcCos 

RngAz 


Magnitude  of  a  vector 

Arc  Sine  of  a  value 

Arc  Cosine  of  a  value 

Finds  range  and  Azimuth  given  two  points 


References 

BMW 


pg.  293-313 


) 
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} 

PROCEDURE  Trajec 


(  LLa t , LLon , TLa t , TLon , Rbo , Q  t  Extended; 
TypePhi  i  Char; 

VAR  Range, Phi, TOP, Az,ICPhl, 

ICVbo,ICRbo  :  Extended; 

VAR  Vn  «  Vactor  )> 

CONST 


Pi  :  Extended  =  3.14159265358979; 

Small  t  Extandad  =  0.000001; 

OmagaEarth  t  Extandad  =  0.0588335906868878; 

Rad  ;  Extandad  =  57.2957795130823; 

Undefined  t  Extandad  «=  999999.1; 

VAR 

a, Ecc,E, RangaOld, Vbo,VBarth,QboMln  s  Extandad; 

1  t  INTEGER; 

BEGIN 

{ -  Inltlaliae  - } 

RangaOld  t=  -1.0; 

1  ;=  1; 

{ - itarata  to  find  tha  flight  time - } 


RngAz(  LLat,LLon,TLat, TLon, 0.0,  Range, Aa  ); 

A  t=  RBo  /  (2.0  -  0); 

QBoHlni=  (  2.0*Sln(Range/2.0)  }  /  (1.0+Sln(Range/2.0)); 

IP  (Q  -  QboHln)  >  0.001  THEN 
BEGIN 

WHILE  (ABS(Ranga01d  -  Ranga)  >  Small)  and  (  1  <  20  )  DO 
BEGIN 

{ - Chack  for  High  or  Low  Plight  Path  Angla - } 

IP  TypePhi  =  'H'  THEN 

Fhlt-  0.5*(  (Pi  -  Arc8IN( ( (2,0-Q)/Q)*8in(Ranga/2.0) )  ) 

-  Ranga/2.0) 

ELSE 

Phli=  0 . 5* (  ArcSINJ ( (2, 0-Q)/Q) *Sln (Ranga/2.0) )  -  Ranga/2.0); 
Ecc  «=  SQRT(  1.0  +  Q*(Q-2.0)*Coa(Phl)*Coa(Phi)  ); 

S  i=  ArcCoa (  (lcc-Co*( Ranga/2.0))  /  (l,0-Ecc*Coa( Ranga/2.0))  ); 
TOP  f *  SQRT(A*A»A)»2.0»(  Pi  -  E  +  Ecc*SIN(E)  ); 

IP  Show  =  'Y 1  THEN 

{)  Wrltaln(  1 ;4,Range*Radtl2i6,Phl*Rad;12;6,e*Rad;12i6,ecctl2t6, 

0  TOF*13.44685108»12»6  ); 

RangaOld;-  Ranga; 

RngAs(  LLat,LLon,TLat, TLon, TOP,  Ranga, Ax  ); 

1;=  1+1; 

END; 

IP  1  >*  20  THEN 

WrltaLn(  'Tha  ltaration  did  not  convarga  In  20  atap*'  ); 

{  -  Evaluate  Influence  Coafficianta  for  unit  errora  -  ) 

VBo  ;=  3QRT(  Q/Rbo  ); 

ICPhl;=  (  (  2.0*Sin(Ranga  +  2.0*Phl)  )  /  8ln(2.0*Phl)  )  -  2.0; 

ICVbo;=  (  8.0*Sln(Range/2.0)*Sln(Range/2.0)  )  / 

(  Vbo*Vbo*VBo«Rbo*Sln(2.0*Phi)  ); 

ICRbo;=  (  4.0*Sin{Range/2.0)*Sln(Range/2.0)  )  / 

(  Vbo+Vbo*RBo*Rbo*8ln(2.0*Phl)  ); 

{  -  Find  Velocity  Naadad,  Relative  Velocity  -  ) 

VEarth;=  OmagaEarth  *  Coa(LLat); 

VN(1);=  -VBo*C0S(  Phi  )*C0S(Aa) ; 

VN(2) t3  VBo*C0S(  Phi  )*SIN(Aa)  -  VBarth; 

VN( 3] ;=  VBo*SIN(  Phi  ); 

HAG(  VN  ); 

END 

ELSE 

BEGIN 

{}  Wrlte(  ' ICBH  does  not  have  enough  energy  -  ’); 

{)  Wrltaln(  1  Q  Hln  =' ,QboHln;12;6  ); 

Phi  ;=  Undefined;  TOP  t=  Undefined; 

lCPhl;=  Undefined;  ICVboi*  Undefined; 

lCRbot=  Undefined;  Vn(4);=  UNdafined; 

END; 

END;  {  Procedure  Trajec  } 
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PROCEDURE  HOHMAMM 


This  procedure  calculates  the  delta  v's  for  a  Hohmann  transfer  for  either 
circle  to  circle,  or  ellipse  to  ellipse.  The  notation  used  it  from  the 
Initial  orbit  (1)  at  point  a,  transfer  is  made  to  the  transfer  orbit  (2) 
and  to  the  final  orbit  (3)  at  point  b. 


Algorithm 


I  Author 

|  Inputs 
R1 
R3 
el 
e3 
NUl 
HU  3 


:  Find  initial  values 

If  the  orbits  are  both  cir  or  ellip,  find  the  answer 
t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  19  Jun  1989 


-  Initial  position  magnitude  DU 

-  Final  position  magnitude  DU 

-  Eccentricity  of  first  orbit 

-  Eccentricity  of  final  orbit 

-  True  Anoaialy  of  first  orbit  0  or  Pi  rad 

-  True  Anomaly  of  final  orbit  0  or  Pi  rad 


I  Outputs 
DeltaVa 
DeltaVb 
TOF 

I  Locals 
SHE1 


I  Constants 
Pi 

I  Coupling 
Nona. 

I  References 
BMW 


-  Change  in  velocity  at  point  a  DU  /  TU 

-  Change  in  velocity  at  point  b  DU  /  TU 

-  Time  of  Flight  for  the  transfer  TU 


-  Specfic  Mechanical  Energy  of  first  orbit  DU2  /  TU 

-  Specfic  Mechanical  Energy  of  transfer  orbltDU2  /  TU 

-  Specfic  Mechanical  Energy  of  final  orbit  DU2  /  TU 

-  Velocity  of  1st  orbit  at  point  a  du  /  TU 

-  Velocity  of  transfer  orbit  at  point  a  DU  /  TU 

-  Velocity  of  transfer  orbit  at  point  b  DU  /  TU 

-  Velocity  of  final  orbit  at  point  b  DU  /  TU 

-  Semi  Major  Axis  of  first  orbit  DU 

-  Semi  Major  Axis  of  Transfer  orbit  DU 

-  Semi  Major  Axis  of  final  orbit  DU 


pg.  163-166 


■5' 


PROCEDURE  Hohmann 


(  Rl,R3,el,e3,Nul,Nu3  i  Extended; 

VAR  Deltava,Deltavb,TOP  t  Extended  ); 

CONST 

Pi  i  Extended  =  3.14159265358979; 

VAR 

SMEl , SME2 f SME3 /  Vl,V2a,V2b,V3,  al,a2,a3  <  Extended; 

BEGIN 

{  -  Initialise  values  -  } 

al  ;=  ( r 1* ( 1 . 0+el*Co« (Nul ) ) )  /  (1.0  -  el*el  ); 
a2  i  =  (  R1  +  R3  >  /  2.0; 

a3  s=  (r3*(1.0+e3*Coe(Nu3) ) )  /  (1.0  -  e3*e3  ); 

SMEl t  =  -1.0  /  (2.0*al); 

SME2 i=  -1.0  /  (2.0*a2) ; 

SME3 i=  -1.0  /  (2.0*a3); 

DeltaVai22  0.0; 

DeltaVb;=  0.0; 

TOP Is  0.0; 

IP  (  al  <  1.0  >  or  (  e3  <  1.0  )  THEN 
BEGIN 


{ -  Plnd  Delta  v  at  point  a  - } 

VI  l  =  SQRT(  2.0*(  (1.0/R1)  +  SMEl  )  ); 

V2ai*  SQRT(  2.0»(  (1.0/R1)  +  8MB2  )  ); 

DeltaVai12  ABS(  V2a  -  VI  ); 

( -  Plnd  Delta  v  at  point  b - } 

V3  I*  SQRT(  2.0*(  (1.0/R3)  ♦  SME3  )  ); 

V2bl=  SQRT(  2.0*(  (1.0/R3)  +  8MR2  )  ); 

DeltaVbi22  ABS<  V3  -  V2b  ); 

{  -  Plnd  Transfer  Ti»e  of  Plight  -  } 

TOP l 22  PI  *  SQRT(  A2*A2*A2  ); 

IP  Show  *  1 Y'  THEN 
BEGIN 

WrlteLn(  1  a2  • ,a2il0i6,'  DU1  ); 

Hrlteln(  1  VI  ',vlil0t6  ); 

HriteLn(  1  V2a  ',v2a«10t(,'  V2b  \v2bil0tfi  ); 

WrlteLn(  *  V3  1 ,v3il0»6  ); 

HrlteLn(  'TOTAL  1 , (DeltaVa+DeltaVb) 1IO16, '  DU/TU'  ); 

END; 

END; 

END;  {  Procedure  Hohaumn  } 
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PROCEDURE  ONETANCENT 


Shit  procedure  calculates  kb*  delta  v's  for  a  On*  Tangent  transfer  for  either 
circle  to  circle,  or  ellipse  to  elllpsi.  She  notation  used  is  from  the 
initial  orbit  (1)  at  point  a>  transfer  is  mad*  to  the  transfer  orbit  (2), 
and  to  the  final  orbit  (3)  at  poink  b. 


Algorithm 

>  Find  the  parameters  for  the  transfer  orbit 

Based  on  the  eccentricity,  find  the 

answer 

Author 

t  Capt  Dave  vallado  USAFA/DfAS  719-* 

172-4109  19 

Jun  1989 

Inputs 

i 

R1 

-  Initial  position  magnitude 

DU 

R3 

-  filial  position  magnitude 

DU 

*1 

-  Eccentricity  of  first  orbit 

*3 

-  Eccentricity  of  final  orbit 

MUl 

-  Sru*  Anomaly  of  first  orbit 

rad 

NU2 

-  True  Anomaly  of  second  orbit 

rad 

Nu3 

-  Sru*  Anomaly  of  final  orbit 

rad 

Outputs 

t 

DeltaVa 

-  Chang*  in  velocity  at  point  a 

DU  /  TU 

DeltaVb 

-  Chang*  in  velocity  at  point  b 

DU  /  TU 

Tor 

-  Tim*  of  flight  for  the  transfer 

TU 

Locals 

t 

SMR1 

-  Specflc  Mechanical  Energy  of  first  orbit 

DU2  /  TU 

SHS2 

-  Specflc  Mechanical  Energy  of  transfer  orbit 

DU2  /  TU 

SMS  3 

-  Specflc  Mechanical  Energy  of  final  orbit 

DU2  /  TU 

VI 

-  Velocity  of  1st  orbit  at  point  a 

DU  / 

TU 

V2a 

-  Velocity  of  transfer  orbit  at  point 

a 

DU  / 

TU 

V2b 

-  Velocity  of  transfer  orbit  at  point 

b 

DU  / 

TU 

V3 

-  Velocity  of  final  orbit  at  point  b 

DU  / 

TU 

e2 

-  Eccentricity  of  second  orbit 

al 

-  Semi  Major  Axis  of  first  orbit 

DU 

a2 

-  Seal  Major  Axis  of  Transfer  orbit 

DU 

a3 

-  Sjml  Major  Axis  of  final  orbit 

DU 

E 

-  Eccentric  anomaly  of  transfer  orbit 

at  point  b 

rad 

Constants 

: 

Non*. 

Coupling 

■ 

Non*. 

References 

i 

BMW 

pg.  163-166 
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} 

PROCEDURE  OneTangent 


(  RJ.,R3,«l,#3,Nul,Nu2,Nu3  s  Extended; 

VAR  Delt*v»,Delt»vb,TOF  t  Extended  ); 

VAR 

SMB1 , SHB2 , SHE 3 ,  Vl,V2a,V2b,V3,  e2,al,a2,a3,  Phl2b,Phi3,  E,  Sinv.Cosv  t  Extend 

BEGIN 

{  -  Initialise  values  -  } 

al  «=  (rl*(1.0+el*Co»(Nul)))  /  (1.0  -  el*el  ); 

e2  i=  (  r3-rl  )  /  (  -r3*Co»(Nu2)+Coe(Nul)*rl  );  {  Coa(Nul)  determines  the  sign} 

IP  ABS{  e2-1.0  )  >  0.000001  THEM 
BEGIN 

a2  »=  (rl*(1.0+e2*Co*(Nul)) )  /  (1.0  -  e2*e2  ); 

SKE2;=  -1.0  /  (2. 0**2); 

END 

ELSE 

BEGIN 

a2  i=  999999.9;  {  Undefined  for  Parabolic  orbit  } 

SHE2:=  0.0; 

END; 

a3  ;=  (r3*(1.0+e3*Co»(Nu3)))  /  (1.0  -  e3*e3  ); 

SNE1 ; =  -1,0  /  (2.0*al) ; 

SME3«=  -1.0  /  (2.0*a3) ; 

{ -  Find  Delta  v  at  point  a - } 

VI  t  =  SQRT(  2. 0* (  (1.0/R1)  -I-  SME1  )  ); 

IF  ABS(  SHE 2  )  >  0.000001  THEN 

V2at  =  SQRT(  2.0*(  (1.0/R1)  +  SME2  )  ) 

ELSE 

V2a«  =  S0RT(  2.0*(1.0/R1)  ); 

DeltaVa;2  ABS(  V2a  -  VI  ); 

{ -  Find  Delta  v  at  point  b  - } 

V3  i=  SQRT(  2 . 0* (  (1.0/R3)  +  SMI 3  )  ); 

IF  ABS(  SHE 2  )  >  0.000001  THEN 

V2b;=  SQRT(  2.0*(  (1.0/R3)  +  8HE2  )  ) 

ELSE 

V2bi=  SQRT(  2.0*(1.0/R3)  ); 

Fhl2bi=  ArcTAN(  (  e2*Sin(Nu2)  )  /  (  1.0  +  e2*Co«(Nu2)  )  ); 

Phl3  « =  ArcTAN(  (  e3*Sin(Nu3)  )  /  (  1.0  +  e3*Coa(Nu3)  )  ); 

DeltaVbi*  SQRT(  V2b*V2b  +  V3*V3  -  2.0»V2b*V3*Cos(  Phl2b-Phi3  )  ); 

{  - - -  Find  Transfer  Time  of  Flight  -  } 

IF  e2  <  0.9999  THEN 
BEGIN 

Sinv;=  (  SQRT(  1.0-e2*e2  )*Sin(Nu2)  )  /  (  1.0  +  e2*Cos(Nu2)  ); 

Coav i =  (  e2+Cos(Nu2)  )  /  (  1.0  *  e2*Coe(Nu2)  ); 

E  i=  AT AN 2 (  Slnv.Coav  ); 

TOP  ;=  SQRT(  A2*A2*A2  )  »  (  E  -  e2»Sin(E)  ); 

END 

ELSE 

BEGIN 

IF  ABS(  e2-l .0  )  <  0.000001  THEN 
BEGIN 

{  Parabolic  TOP  } 

END 

ELSE 

BEGIN 

{  Hyperbolic  TOF  } 

END; 

END; 


{} 

U 

U 

{} 

U 

{} 

{) 

U 

{} 

{} 


IF  Show  =  ' Y •  THEN 
BEGIN 

WrlteLn<  '  a2 
WriteLn(  '  VI 
WrlteLn(  1  V2a 
WrlteLn(  •  V3 
WrlteLn(  'TOTAL 
WrlteLn(  '  *2 
Wr iteLn(  1  Phl2 
END; 


' ,a2tl0i6i 1  DU'  ); 

\vlil0t6  ); 

* , v2a i 10 i 6 , 1  V2b  • , v2b: 10 i 6  ); 

' , v3 1 10 1 6  ); 

* , (DeltaVa+DeltaVb ) 1 10 1 6 , '  DU/TU'  ); 

\e2tl0i6,'  E  =  1 ,E*57.2955il0i6< 1  a2  ',a2;10i6  ); 

' ,Phl2b*57.2955il0i6i 1  Pbl3  =  \Phl3*57.2955»10;6  ); 


END;  {  Procedure  OneTangent  } 
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PROCEDURE  GENERALCOPLAMAR 


Ibis  procedure  calculate*  tha  delta  v'i  for  a  general  coplanar  tranafer  for 
either  circle  to  circle/  or  ellipae  to  ellipse.  The  notation  used  is  froa 
the  initial  orbit  (1)  at  point  a#  transfer  is  made  to  the  transfer  orbit  (2) 
and  to  the  final  orbit  (3)  at  point  b. 


Algorithm 

$ 

Author 

»  Capt  Dave  Vallado  USAPA/DPA8  719-472-4109 

14  Mar  1989 

Inputs 

t 

R1 

-  Initial  position  magnitude 

DU 

R3 

-  Final  position  magnitude 

DU 

el 

-  Eccentricity  of  first  orbit 

e3 

-  Eccentricity  of  final  orbit 

Nul 

-  True  Anomaly  of  first  orbit 

rad 

Nu3 

-  True  Anomaly' of  final  orbit 

rad 

Outputs 

: 

DeltaVa 

-  Change  in  velocity  at  point  a 

DU  /  TU 

DeltaVb 

-  Change  in  velocity  at  point  b 

DU  /  TU 

TOP 

-  Time  of  Plight  for  the  transfer 

TU 

Locals 

t 

SHE1 

-  Specfic  Mechanical  Energy  of  first  orbit 

DU2  /  TU 

SMC  2 

-  Specfic  Mechanical  Energy  of  transfer  orbit 

DU2  /  TU 

SMI  3 

-  8pecflc  Mechanical  Energy  of  final  orbit 

DU2  /  TU 

VI 

-  Velocity  of  1st  orbit  at  point  a 

DU  /  TU 

V2a 

-  Velocity  of  transfer  orbit  at  point  a 

DU  /  TU 

V2b 

-  Velocity  of  tranafer  orbit  at  point  b 

DU  /  TU 

V3 

-  Velocity  of  final  orbit  at  point  b 

DU  /  TU 

al 

-  Semi  Major  Axis  of  first  orbit 

DU 

a2 

-  Semi  Major  Axis  of  Transfer  orbit 

DU 

a3 

-  Semi  Major  Axis  of  final  orbit 

DU 

E 

-  Eccentric  anomaly  of  transfer  orbit  at  point 

b  rad 

Constants  i 
None. 


Coupling  i 

None. 


References 


PROCEDURE  GeneralCoplanar  (  Rl,R3,el.02,e3,Nul,Nu2a,Nu2b,Nu3 

VAR  Deltava,DeitAVb,TOF 

VAR 

SMS1,SMB2,SHE3,  Vl,V2a,V2b,V3,  al,a2,a3,Phil,Phi2a,Phi2b,Phl3, 
E,Bo,31nv,Cosv  >  Extended; 

BEGIN 

{  -  Initialise  valuaa  -  } 

al  «=  ( rl* ( 1 . 0+el*Cos ( Nul ) ) )  /  (1.0  -  el*el  ); 

IF  ABS(  «2-1.0  )  >  0.000001  THEN 
BEGIN 

a2  (rl*(1.0+«2*Coa(Nu2a)))  /  (1.0  -  e2*e2  ); 

SMI2t=  -1.0  /  (2.0*»2)> 

END 

ELSE 

BEGIN 

a2  «=  999999.9;  {  Undefined  for  Parabolic  orbit  } 

SHB2 1  =  0.0; 

END;  ' 

a3  ;=  (r3*(1.0+e3*Cos(Nu3) ) )  /  (1.0  -  e3*e3  ); 

SHE1:=  -1.0  /  (2.0*al); 

SME3i=  -1.0  /  (2.0*a3); 

{ -  Pina  Delta  v  at  point  a  - } 

VI  ;  =  SQRT{  2.0*(  (1.0/R1)  +  SMI1  )  ); 

V2ai*  SQRT(  2.0*(  (1.0/R1)  +  SMX2  )  >; 

Phi2ai=  ArcTAN(  (  «2*Sln(Nu2a)  }  /  (  1.0  +  a2*Coa(Nu2a)  )  ); 

Phil  ;*  ArcTAN(  (  al*81n(Mul)  )  /  (  1.0  +  fl*Coe(*ul)  )  ); 

D»ltaVai=  SQRT(  V2a*V2«  +  V1*V1  -  2.0»V2a*Vl*Coa(  Phl2a-Phil  )  ); 

{ -  i>ina  Delta  v  at  point  b  - } 

V3  t=  SQRT(  2.0*(  (1.0/R3)  +  8NE3  )  ); 

V2bi=  8QRT(  2.0*(  (1.0/S3)  +  SKE2  )  ); 

Phi2bi=  ArcTAN(  (  e2*Sln(Nu2b)  )  /  (  1.0  +  «2*Coa(Nu2b)  )  ); 

Phl3  t=  ArcTAN(  (  a3*Sln(Nu3)  )  /  (  1.0  +  e3*Coa(Nu3)  )  ); 
DeltaVb;*  8QRT(  V2b«V2b  ♦  V3*V3  -  2.0*V2b*V3*Coa(  Pbl2b-Phl3  )  ); 

{ -  Pi„a  Transfer  Tina  of  Flight  - } 

31nvi=  (  SQRT(  1.0-e2*a2  )*8in(Nu2b)  )  /  (  1.0  +  #2*Co»(Nu2b)  ); 
Co«v:=  (  a2+Cos(Nu2b)  )  /  (  1.0  +  e2*Coe(Nu2b)  )» 

Et  =  AT AN 2 (  Slnv.Coav  ); 

Sinvi*  (  SQRT(  1.0-#2‘t2  )*81n(Nu2a)  )  /  (  1.0  +  #2*Coa(Nu2a)  ); 
Coav;=  (  e2+Co»(Nu2a)  )  /  (  1.0  f  e2*Co»(Nu2a)  ); 

Eoi=  AT AN 2 (  8inv,Coav  ); 

TOFi»  SQRT(  A2*A2*A2  )*((«-  *2*81n(E))  -  (So  -  a2*8in(«o))  )> 
END;  (  Procedure  GaneralCoplanar  } 


i  Extended; 
s  Extended  ); 
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} 

{ - 

I 

I  PROCEDURE  RENDEZVOUS 

I 

I  This  procedure  calculates  parameters  for  a  Hohaann  transtar  rendeavous. 

I  Algorithm  <  Calculate  tha  anawar 

I  Author  t  Capt  Dava  Vallado  USAFA/DFAS  719-472-4109  23  Sap  1988 


Inputs  < 

Real  -  Radius  of  circular  orbit  intarcaptor  DU 

Res 2  -  Radius  of  circular  orbit  target  DU 

Phaser  -  Initial  phase  angle  rad 

NuaRevs  -  Number  of  revs  to  wait 

Outputs  > 

Phase?  -  Final  Phase  Angle  rad 

WaitTime  -  Nait  before  neat  Intercept  opportunity  TU 

Locals  t 

TOFTrans  -  Tiae  of  flight  of  transfer  orbit  TU 

ATrans  -  Seal-aajor  axis  of  transfer  orbit  DU 

VelTgt  -  Velocity  of  target  rad  /  TU 

Vellnt  -  Velocity  of  interceptor  rad  /  TU 

LeadAng  -  Lead  Angle  rad 


I  Constants  i 

i  Pi 

I  Coupling  i 

I  None. 

I 

i  References  i 

I  BMW  pg. 

PROCEDURE  Rendeavous  (  Rcsl,Rcs2,PhaseI  t  Extended! 

NuaRevs  i  Integer! 

VAR  Phaser, WaltTlae  i  Extended  ) j 

CONST 

Pi  t  Extended  *  3.141592«S358979| 

VAR 

TOFTrans, LeadAng, aTrans, VelTgt, Vellnt  i  Extended! 

BEGIN 

ATrans  «=  (Real  +  Rcs2)  /  2.0j 
TOFTrans i =  P1*SQRT(  ATrans*ATrans*ATrans  )t 
Vellnt  i=  1.0  /  (  SQRT(Rcal*Rcsl*Rcsl)  )i 
VelTgt  i=  1.0  /  (  8QRT(Rca2*Rcs2*Rcs2)  )i 

LeadAng  «=  VelTgt  *  TOFTRans! 

Phase?  i=  Pi  -  LeadAngi 

WaitTime t=  (  Phaser  -  Phaser  +  2.0*Pl*Mua«evs  )  /  (  Vellnt  -  VelTgt  )! 

{}  IF  Show  *  ’?•  THEN 
{}  BEGIN 

{}  Wrlteln(  1  A  transfer  =  1 ,ATRansil2t8,  '  DU  '  )j 

{}  Writeln(  '  TOT  Transfer*  1 ,TOTTRans«12i8, '  TU  •  )i 

{}  WrlteLn(  •  VelTgt  *  ' ,VelTgtil2i8,  ■  rad/TU'  )i 

{}  WriteLn(  ‘  Vellnt  =  ' ,7olIntil2t8,  '  rad/TU'  )i 

{}  Writelnf  '  Lead  Angle  *  ' ,LeadAng»57.29578il2i8, •  V  }i 

U  END) 

END)  {  Procedure  Rendeavous  } 
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PROCEDURE  INTERPLANETARY 


This  procedure  calculates  the  delta  v'a  for  an  Interplanetary  Mission.  The 
transfer  assumes  circular  orbits  for  each  of  the  planets,  notice  the 
units  are  all  metric  since  this  procedure  is  designed  for  AMY  planet  and 
sur.  system.  This  eliminates  having  knowledge  of  cannonlcal  units  for 
each  planet  in  the  calculations. 

Algorithm  s  Calculate  the  answer 

Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  19M 


Inputs  > 

R1  -  Radius  of  planet  1  from  sun  km 

R2  -  Radius  of  planet  2  from  sun  km 

Rbo  -  Radius  at  burnout  about  planet  1  km 

Rimpact  -  Radius  at  impact  on  planet  2  km 

Mul  -  Gravitational  parameter  of  planet  1  k«3/s2 

Hut  -  Gravitational  parameter  of  planet  Sun  km3/s2 

Mu 2  -  Gravitational  parameter  of  planet  2  km3/s2 

Outputs  i 

DeltaVl  -  Hyperbolic  Ixcesa  velocity  at  planet  1  SOI  km/s 

DeltaV2  -  Hyperbolic  Ixcesa  velocity  at  planet  2  SOI  km/s 

Vbo  -  Burnout  velocity  at  planet  1  km/s 

Vretro  -  Retro  velocity  at  surface  of  planet  2  km/s 

Locals  t 

SME1  -  Specfic  Mechanical  Inergy  of  1st  orbit  Xm2/s 

SHBt  -  8pecflc  Mechanical  Inergy  of  transfer  orbit  Ka£/s 

SHE 2  -  Specfic  Mechanical  Inergy  of  2nd  orbit  Km2/s 

vcsl  -  Velocity  of  1st  orbit  at  delta  v  1  point  im/s 

Vcs2  -  Velocity  of  2nd  orbit  at  delta  v  2  point  Km/s 

Vtl  -  Velocity  of  Transfer  orbit  at  delta  v  1  point  Km/s 

Vt2  -  Velocity  of  Transfer  orbit  at  delta  v  2  point  Km/s 

A  -  Semi  Major  Axis  of  Transfer  orbit  Km 


Constants  s 

Hone. 

Coupling  s 

None. 

References  « 

BMW  pg. 
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} 

procedure  Interplanetary  (  Rl,R2,Rbo,Ria|>act,Mul,Mut,Hu2  t  Extended; 

VAR  Deltavl>Deltav2,Vbo,Vretro  t  Extended  ); 

VAR 

SMEl,SME2,SMEt,  Veal,  Vc(2,  Vtl,  Vt2,  A,TP  t  Extended; 

BEGIN 

{  -  Find  a,  SHE.  apogee  and  perigee  velocltlea  of  tranefer  orbit  -  } 

A  I-  (R1+R2)  /  2.0; 

SMEts-  -Nut/  (2,0*A); 

Vtl  i=  SQRT(  2.0* f  (Hut/Rl)  +  8KEt  )  ); 

Vt2  i=  SQRT(  2.0* (  (Nut/R2)  +  SNEt  )  ); 

{  -  Find  circular  velocltlea  of  launch  and  target  planet  -  } 

Vcal;=  SQRT(  Hut/Rl  ); 

Vca2»=  SQRt(  Hut/R2  );  . 

{  -  Find  delta  velocltlea  for  Hohaann  tranafer  portion  -  } 

DeltaVl:-  ABS(  Vtl  -  Veal  ); 

DeltaV2i=  ABS(  Vca2  -  Vt2  ); 

{  -  Find  SMB  and  burnout/lapact  vel  of  launch  /  target  planata  -  } 

SHE1  I*  Deltavl*DeltaVl  /  2.0; 

SME2  :=  Deltav2*DeltaV2  /  2.0; 

Vbo  >=  SQRT(  2.0*(  (Kul/Rbo)  +  8ME1  )  ); 

Vretroi=  SQRT(  2.0*(  (Mu2/Rlapact)  +  8HE2  )  ); 

{}  IF  Show  =  'Y'  THEN 
{}  BEGIN 

{}  TPt=  P1*9QRT(  a*a*a/Mut  );  {  Tranafer  Period  in  aeca  } 

(}  WrlteLn(  •  Tranafer  Period  «• ,TP/3.1S36E07«a«3, '  yra  or  •, TP/86400. Q«8»3, ' 

{}  Hriteln; 

{}  Wrltelnj  'Vca  K«/a‘ «19,vcali9i4, '  1 tl0,vce2i9;4); 

{}  WrlteLnj  1  Vt  ke^a' «19,vtl»9i4, '  ' Il0,vt2«9;4  ); 

{}  WrlteLn(  1  SHE  kat2/e2 ' 1 19 , SNB1 1 9 1 4 ,  '  ,8KEt»9:3,8HK2i9i4  ); 

{)  END; 

END;  {  Procedure  Interplanetary  } 
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PROCEDURE  REENTRY 


This  procedure  calculates  various  reentry  parameters  using  the 
Allan  i  Eggars  approximations. 


Algorithm 

Author 

Inputs 

Vra 

PhiRt 

BC 

h 

Outputs 

V 

Dacl 

MaxDecl 

Locals 

grav 

Rho 

Constants 

ScalaHt 

Coupling 

Nona. 

References 

Nona. 


s  Find  tha  answer 

t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  14  Apr  1989 


-  Reentry  Velocity 

-  Reentry  Flight  Path  Angle 

-  Ballistic  Coefficient 

-  Altitude 


-  Velocity 

-  Declaration 

-  Maximum  Declaration 


m/a 

rad 

kg/m2 

km 


km /s 

g's 

g's 


-  Temporary  variable  to  hold  Weight  component 

-  Atmospheric  density  kg/m3 


-  Scale  height  used  to  exponentially  ^el  atmosp  1.0/7.315 


PROCEDURE  Reentry  (  Vre,PhiRe,BC,h  i  Extended; 

VAR  V,Decl,HaxDecl  i  Extended  ); 

VAR 

8caleHt,grav,Rho  ;  Extended; 

BEGIN 

ScalaHt i a  1.0/7.315; 

Rho;  =  1,225*EXP(  -ScaleHt*h  ); 

V  i=  Vre  *  EXP(  (1000.0*Rho  )  /  ( 2 , 0*BC*8caleHt*8in(PhlRe) )  ); 
gravi=  9.80*8ln(PhlRe); 

Dacl;*  ((-0.5*Rho*v*V)  /  BC  )  +  grav; 

Dacl;*  Dacl/9.80; 

MaxDecl ; »  (-0.5*ScaleHt*Vre*Vte*81n(Phlre))  /  (9.80*BXP(1.0)); 
MaxDecl;*  MaxDecl/9.80; 

END;  {  Procedure  Reentry  } 


{ 
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PROCEDURE  HILL  SR 


This  procedure  calculates  various  position  Information  for  Hills  aquations 
Notice  the  nz  system  used  haa  I  Collnear  with  Target  Position  vector, 

Z  normal  to  target  orbit  plane,  and  x  In  direction  of  velocity. 

Algorithm  t  Find  the  answer 


Author 


Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  8  Hay  1989 


Inputs 

R 

V 

Alt 

T 


: 

-  Initial  Position  vector  of  INI  DU 

-  Initial  Velocity  Vector  of  UR  DU  /  TU 

-  Altitude  of  TOT  satellite  DU 

-  Desired  Tima  TU 


Outputs 

R1 

VI 


Locals 


I 

-  Final  Position  vector  of  UR 

-  Final  Velocity  Vector  of  UR 

s 


DU 

DU  /  TU 


Constants  t 

Coupling  t 

None. 


References 

Kaplan 


> 

pg  108  -  115 


PROCEDURE  HlllsR 


(  r,v 
Alt,t 
VAR  R1,V1 


i  Vector; 
i  Extended; 
t  Vector 


VAR 

SlnNt, CosNt, Omega, nt, Radius  t  Extended; 

BEGIN 

{  - -  Initialise  the  orbit  alemnts  -  } 

Radius t=  1.0  +  Alt; 

0*igai  =  SQRT(  1.0  /  Radius  ); 
nt  i=  Omega*t; 

CosNt i =  Cos(  nt  ); 

SlnNti=  Sln(  nt  ); 

{ - Determine  new  positions  - } 

R1(U Is  (  2.0*V[2]/Omega  )  *  CosNt  + 

(  (4.0*V(1]/Omega)  +  6.0*R(2]  )  *  SlnNt  + 

(  R[l]  -  (2.0*V[2]/Omega)  )  - 
(  3.0*V[1]  +  6.0*Omega*R[2]  )*t; 
ai[2]«=  (  v[2]/Omega  )  *  SlnNt  - 

(  (2.0*V(1]/Oawga)  +  3.0*R[2]  )  *  CosNt  + 

(  (2.0*V[1)/Omega)  +  4.0*R[2]  ); 

Rl[3) «*  R[3]*CoaNt  +  (V[3]/Omega)*81nNt; 

{ - Determine  new  velocities  - } 

Vl[2]»=  0.0; 

Vl[l]:=  0.0; 

Vl[3]i=  0.0; 

BHD;  {  Procedure  HlllsR  } 


} 

{ 


PROCEDURE  HIZiLSV 


This  procedure  calculatss  initial  vaiocity  for  Hills  aquations. 

Notice  the  XYZ  system  used  has  T  Collnear  with  Target  Position  vector, 
Z  normal  to  target  orbit  plane,  and  x  in  direction  of  velocity. 

Algorithm  >  Check  for  a  divide  by  sero,  then 
Find  the  answer 

Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  8  Kay  1989 


Inputs 

R 

Alt 

T 


-  Initial  Position  vector  of  INT 

-  Altitude  of  TOT  satellite 

-  Desired  Time 


DU 

DU 

TU 


Outputs 

V 


Locals 

Constants 

Coupling 

None. 


; 

-  Initial  Velocity  Vector  of  INT 

t 

i 

i 


References 

Kaplan 


pg  108  -  115 


DU  /  TU 


} 


PROCEDURE  HlllsV 


(  * 

Alt,  t 
VAR  V 


>  Vector ; 
i  Extended; 
i  Vector  ) ; 


VAR 

Numer,Dano«,SlnNt,CosNt, Omega, nt, Radius  i  Extended; 

BEGIN 

{  -  initialise  the  orbit  elemnts  -  } 

Radius;*  1.0  +  Alt; 

Omega;*  SQRT(  1.0  /  Radius  ); 
nt  ;*  Omega*t; 

CosNt;*  Cos(  nt  ); 

SlnNt;*  Sin{  nt  ); 

{ - Determine  initial  Velocity - } 

Numer;*  (  (6.0*r[2)*(nt-SINnT)-rtl))*Omega*81nnt-2.0*Omega*r[2)* 
(4.0-3.0*Cosnt)*(1.0-C08nt)  ); 

Denorn;*  (4.0*Slnnt-3.0*nt)*Sinnt  +  4.0*(  1.0-CosNt  )  *  (  1.0-CosNt  ); 

IF  AB3(  Denorn  )  >  0.000001  THEN 
V(l];*  Numer  /  Denorn 
ELSE 

V[l];=  0.0; 

IF  AB8<  SinNt  )  >  0.000001  THEN 

V(2];=  -(  Omegatr(2]*(4.0-3.0*Co»nt)+2,0*(l.0-Cosnt)*v{l]  )  / 

(  SinNt  ) 

ELSE 

V[2];=  0.0; 

vt  3]  ;=  0.0; 

END;  {  Procedure  HlllsV  } 
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PROCEDURE  TARGET 


This  procedure  accomplishes  tha  targating  problem  using  KEPLER  and  GAU8S. 


Algorithm  t  Propogate  tha  target  forward 
Find  the  intercept  trajectory 
Calculate  the  change  in  velocity  required 

Author  :  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  8  Jun  1990 


Inputs 

RInt 

Vint 

RTgt 

VTgt 

dm 

TOF 


< 

-  Initial  Position  vector  of  Interceptor  DU 

-  Initial  Velocity  vector  of  Interceptor  DU/TU 

-  Initial  Position  vector  of  Target  DU 

-  Initial  Velocity  vector  of  Target  DU/TU 

-  Direction  of  Notion  for  Gauss  'L'.'S' 

-  Time  of  flight  to  tha  Intercept  TU 


Outputs 

Vlt 

V2t 

DV1 

DV2 


Initial  Transfer  Velocity  vector 
Final  Transfer  Velocity  vector 
Initial  Change  Velocity  vector 
Final  Change  Velocity  vector 


DU/TU 

DU/TU 

DU/TU 

DU/TU 


Dirac  -  Direction  of  transfer  ,DNu  Is  or  gt  Pi  1 1* 1 ,  ’ S  ■ 


Locals  t 

TransNormal  - 
intNorawl 
RITgt 
VITgt 
RIRT 

CosDeltaNu  - 
SlnDeltaNu  - 
DeltaNu 


Cross  product  result  of  transfer  orbit 
Cross  product  result  of  interceptor  orbit 
Position  vector  after  TOF  of  Target 
Velocity  vector  after  TOF  of  Target 
RInt [4]  *  RlTgt[4] 

Cosine  of  DeltaNu 
Sine  of  DeltaNu 

DeltaNu.  angle  between  position  vectors 


DU 

DU 

DU 

DU/TU 

rad 

rad 

rad 


Constants  i 
None 


Coupling 

CROSS 

KEPLER 

GAUSS 

LNCOM2 

DOT 


Cross  product  of  two  vectors 

Find  R  and  V  at  future  time 

Find  velocity  vectors  at  each  end  of  transfer 

Linear  coafcination  of  two  vectors  and  constants 

DOT  product  of  two  vectors 


References 

None. 


} 


PROCEDURE  TARGET 


VAR 

intNormal,  TransNoraal. 
Temp,  RIRT,  CosDeltaNu, 
BEGIN 

{  -  Propogate 

KEPLER (  RTgt, VTgt, TOF, 


(  RInt, Vint, RTgt, VTgt 

Dm 

TOF 

VAR  Vlt,V2t,DVl,DV2 

RITgt,  VITgt 
SlnDeltaNu,  DeltaNu 

target  forward  by  TOF  — 
RITgt, VITgt  )? 


i  Vector j 
>  CHAR) 
t  Extended) 

:  Vector  ) ) 

Vector) 

EXTENDED) 


} 


{ - Calculate  transfer  orbit  between  r's - } 

GAUSS (  RInt, RITgt, dm, TOF,  Vlt,V2t  )) 


LNC0M2(  -1.0,  1.0, Vint,  Vlt,  DV1  )) 
LNCOM2(  1.0, -1.0, VITgt, V2t,  DV2  )) 


IF  Vlt£  4 ]  <  0.00001  THEN 
DV1[4]:=  100.0) 

END)  {  Procedure  Target  } 


A -Si 


} 

{ - 

I 

|  PROCEDURE  PKKPLEP 

!  This  procedure  propagates  a  satellite's  position  and  velocity  vector  over 
1  a  given  time  period  accounting  for  perturbation*  caueed  by  J2.  The 
j  satellite's  original  position  and  velocity  vectors  are  inputed  together 
•  with  the  time  the  elements  are  to  be  propagated  for.  The  updated  position 
I  and  velocity  vectors  are  then  output. 

i  Algorithm  «  Find  the  value  of  the  perturbations 
j  Determine  the  type  of  orbit 

I  Update  the  appropriate  parameters 

j  Find  the  new  position  and  velocity  vector* 

I  Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  6  Jan  1990 


Inputs  t 

R  -  original  position  vector  DU 

V  -  original  velocity  vector  DU/TU 

DeltaT  -  time  for  which  orbital  elements  are  to  TU 

Outputs  > 

R1  -  updated  position  vector  DU 

VI  -  updated  velocity  vector  DU/TU 

Locals  i 

P  -  Seml-paramter  DU 

A  -  uemlmajor  axis  DU 

E  -  eccentricity 

Inc  -  inclination  rad 

Argp  -  argument  of  periapsis  rad 

ArgpDot  -  change  in  argument  of  periapsis  radAU 

Omega  -  longitude  of  the  ascending  nod*  rad 

OmegaDot  -  change  in  Omega  rad 

E0  -  eccentric  anomaly  rad 

El  -  eccentric  anomaly  rad 

N  -  mean  anomaly  radAU 

KDot  -  change  in  mean  anomaly  radAU 

Uo  -  argument  of  latitude  rad 

UDot  -  change  in  argument  of  latitude  radAU 

Lo  -  true  longitude  of  vehicle  rad 

LDot  -  change  in  the  true  longitude  rad/T'J 

CapPlo  -  longitude  of  periapsis  rad 

CapPloDot  -  longitude  of  periapsis  change  rad/TU 

N  -  mean  angular  motion  rad/?U 

NUo  -  true  anomaly  rad 

J2oP2  -  J2  over  p  sqyared 

SlnViCosv  -  Sin*  and  Cosine  of  Nu 


Constants  i 

Pi 

TwoPi 

J2  -  J2  constant  from  the  Barth's  geopotential  function 

Small  -  Tolerance 

Coupling! 

ELORB  -  Orbit  Elements  from  position  and  Velocity  vectors 

RANDV  -  Position  and  Velocity  Vectors  from  orbit  elements 

NewtonR  -  Newton  Rhapson  to  find  Nu  and  Eccentric  anomaly 

RealMod  -  Real  MOD  operation 

References  t 

Escobal  pg  369.  Dot  terms 

BMW  pg 
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} 

PROCEDURE  PKepler  (  Ro.Vo 

DeltaT 
VAR  R,V 

CONST 

TwoPl  i  Extended  a  6.283185307179591 

Pi  :  Extended  -  3. 1.4159265358979 ; 

J2  >  Extended  *  0.00108263; 

Small  s  Extended  =  0.000001; 

VAR 

P, A, E,Inc,Omega,Argp,Nuo,H,Uo,Lo, CapPlo, OmegaDot, E0, 

ArgpDot , KDot, UDot ,LDot,CapFiDot,N,J2oP2,NBar  s  Extandad; 

TypaOrblt  t  8TRINC(2]; 

BEGIN 

ELORB(  Ro, Vo, P, A, E, Inc, Omega, Argp, Nuo,M,Uo,Lo, CapPlo); 
n»*  SQRT( 1 . 0/ (A*A*A) ) ; 

{ - Find  tha  valua  of  J2  perturbation* - } 

J2oP2?=  (1.5M2)  /  (p*p); 

NBarj*  n*(  1.0  +  J2oP2*8QRT(1.0-e*e)*  (1.0  -  1.5*Sin(Inc)*Sln(lnc) )  ); 
OmegaDot!*  -J2oP2  *  Co* (Inc)  *  NBar; 

ArgpDot s*  J2oP2  *  (2.0-2.5*Sln(Inc)*Sln(Inc))  *  Nbar; 

MDot  i*  NBar; 

{  KDot  =  -{6. 0/3.0)  *  (1.0-E)  *  (NDot/Nbar)  Drag  Term*} 

{ -  Determine  type  of  orbit  for  later  u*a  - } 

{  —  Elliptical,  Parabolic,  Hyperbolic  Inclined  —  } 
TypeOrbltt*  'El1; 

IP  E  <  Small  THEN 

{  -  Circular  Equatorial  -  } 

IF  (  Inc  <  Small  )  or  (  ABB(Inc-Fl)  <  Small  )  THEN 
TypeOrbltt*  'CB' 

ELSE 

{  -  Circular  Inclined  -  } 

TypeOrbltt*  'Cl' 

EtSB 

,  (  —  Elliptical,  Parabolic,  Hyperbolic  Equatorial  —  } 

IP  (  Inc  <  Small  )  or  (  ABS(Inc-Pl)  <  Small  )  THEN 
TypeOrbltt*  'EE'; 

{  -  Update  the  orbital  element*  for  each  orbit  type  -  } 

{ - - —  Elliptical  -  Inclined  — — - } 

IP  TypaOrblt  *  'El'  THEN 
BEGIN 

Omega t*  Omega  +  OmegaDot  *  DaltaT; 

Omegat*  RRALMOD(Omega,  TwoPl); 

Argp  t*  Argp  t-  ArgpDot  *  DeltaT; 

Argp  1=  REAUtOD(Argp,  TwoPl); 

H  t=  N  +  KDOT  •  DeltaT; 

M  t=  RBALM0D(K,  TwoPl); 

NewtonR(  e,m,  e0,Nuo  ); 

END; 

{ - Circular  Inclined - } 

IF  TypaOrblt  *  'Cl'  THEN 
BEGIN 

Omegat*  Omega  +  OmegaDot  *  DeltaT; 

Omegat*  REALHOD (Omega,  TwoPl); 

UDot  t*  ArgpDot  +  MDot; 

Uo  i=  Uo  +  UDot  *  DeltaT; 

Uo  i*  RBALMOQ ( Uo ,  TwoPl); 

END; 

{  -  Elliptical  -  Equatorial  -  } 

IP  TypaOrblt  *  'BE'  THEN 
BEGIN 

CapPiDott*  OmegaDot  +  ArgpDot; 

CapPlo  t=  CapPlo  +  CapPlDot  *  DeltaT; 

CapPlo  t*  REALHOD (CapPlo,  TwoPl); 

H  i=  M  +  KDOT  *  DeltaT; 

H  t*  REALM0D(K,  TwoPl); 

NewtonR(  e,m,  c0,Nuo  ); 

END; 

{ - Circular  -  Equatorial - } 

IP  TypaOrblt  *  'CE'  THEN 
BEGIN 

LDoti*  OmegaDot  +  ArgpDot  +  MDot; 

Lo  t=  Lo  +  LDot  *  DaltaT; 

Lo  t*  REALHOD (Lo,  TwoPl); 

END; 


:  Vector; 
t  Extended; 
t  Vector  ) ; 


{ - - - u*e  RANDV  to  find  new  vector* - } 

RANDV(  P,E,  Inc,Om*ga , Argp, tiuo,Uo,Lo, CapPlo,  R,V  ); 

END;  {  Procedure  PKepler  } 
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PROCEDURE  J2DRAGPKRT 


This  procsdurs  calculates  th*  psrturbations  for  ths  predict  problsm 
involving  sscular  ratta  of  change  rssultlng  from  J2  and  Crag  only. 


I  Algorithm 


i  Find  tha  startup  valuas 
Calculate  tha  dot  terms 


I  Author 

|  Inputs 
Inc 

a 

N 

NDot 

I  Outputs 
OmagaDot 
ArgpDot 
BDot 

I  Locals 
P 
A 


t  Capt  Dave  Vallado  uPAFa/dfas  719-472-4109  14  Mar  1989 


-  Inclination 

-  Eccentricity 

-  Mean  Motion 

-  Mean  Motion  rata 


-  Long  of  Asc  Mode  rata 

-  Argument  of  perigee  rata 

-  Eccentricity  rate 


-  Semi-parameter 

-  Semi-major  axis 


rad/TU 
rad  /  2TU2 


rad  /  TU 
rad  /  TO 
/  TU 


Constants 

J2 


J2  zonal  haraenlc 


|  Coupling 
POWER 

References 

Escobal 


Raise  a  base  to  a  power 


pg.  369 


O'Keefe  at  rl.,  Astronomical  3,  Vol  64  nua  7,  pg.  247  for  Edot 


PROCEDURE  J2DragPert  (  Inc, I, M, NDot  t  Extended} 

VAR  OmegaDOT,ArgpDOT,EDOT  i  Extended  ); 

CONST 

J2  <  Extended  =  0.00101263; 

VAR 

P,A,NBar  t  Extended; 

BEGIN 

a  ;=  Pover(  1.0/n  ,  2. 0/3.0  ); 

p  i=  a*(1.0-e*e); 

NBari=  n*(  1.0+1.5*J2*(SORT(1.0-e*e)/(p*p))*(1.0-1.5*Sin{lnc)*Sln(lnc)  )); 

( - Find  dot  terms  - } 

OmegaDoti®  -1.5*(  J2/(p*p)  )  »  Coi(inc)  *  NBar; 

ArgpDot  ;=  1.5*(  J2/(p»p)  )  *  (2.0-2.5*Sln( inc)*Sln( Inc) )  *  Nbar; 

EDot  t=  -(4. 0/3.0)  •  (1.0-8)  *  (MDot/Nbar); 

END;  {  Procedure  J2DragPert  } 
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PROCEDURE  PREDICT 


This  procedure  determines  the  azimuth  and  elevation  for  the  viewing 
of  a  staellite  from  a  known  ground  site.  Notice  the  Julian  Date  is  left 
in  it's  usual  DATS  format  since  the  dot  terms  are  input  as  radians  per 
day,  thus  no  extra  need  for  conversion.  The  Julian  Date  also  facilitates 
finding  the  site  position  vector.  Also  observe  RANDV  is  not  used  since 
this  would  merely  accomplish  extra  calculations.  The  Iteration  is  left 
out  to  allow  the  user  to  set  up  his  own  loop  to  look  for  sighting  times. 

Algorithm  t 

Author  i  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  11  Dec  1990 


Inputs  t 

JD  -  Julian  Date  of  desired  observation  Day 

JDEpoch  -  Julian  date  of  epoch  for  satellite  Day 

No  -  Epoch  Mean  motion  rad/day 

Ndot  -  Epcoh  Half  Mean  Motion  Rate  rad/2day2 

Eo  -  Epoch  Eccentricity 

Edot  -  Epoch  Eccentricity  rate  /day 

Inco  -  Epoch  Inclination  rad 

Omegao  -  Epoch  Lon  of  Asc  node  rad 

OmegaDot  -  Epoch  Lon  of  Asc  Node  rate  rad/day 

Argpo  -  Epoch  Argument  of  perigee  rad 

ArgpDot  -  Epoch  Argument  of  perigee  rate  rad/day 

Mo  -  Epoch  Mean  Anomaly  rad 

Lat  -  Geodetic  Latitude  of  site  rad 

Lon  -  Longitude  of  site  rad 

Alt  -  Altitude  of  site  DU 

Outputs  t 

Rho  -  Range  from  site  to  satellite  DU 

Az  -  Azimuth  rad 

El  -  Elevation  rad 

RtAsc  -  Right  ascension  rad 

Decl  -  Declination  rad 


Vis  -  Visibility  'Radar  Sun',  'Eye',  'Radar  Nlte',  'Not  Visible' 

Locals  i 

Variable  o  -  denotes  the  epoch  value,  while  no  o  is  current 
Dt  -  Change  in  time  from  Epoch  to  desired  t  day 


A  -  Seal  major  axis  DU 

EO  -  Eccentric  Anomaly  rad 

Nu  -  True  Anomaly  rad 

LST  -  Local  Sidereal  Time  rad 

GST  -  Greenwich  Sidereal  Time  rad 

Temp  -  Temporary  Real  value 

SRtAsc  -  Suns  Right  ascension  rad 

SDecl  -  Suns  Declination  rad 

Theta  -  Angle  between  IJK  Sun  and  Satellite  vecrad 

Dlst  -  Ppdculr  distance  of  satellite  from  RSunDU 

Small  -  Tolerance  of  small  values 

R  -  IJK  Satellite  vector  DU 

RS  -  IJK  Site  Vector  DU 

VS  -  Site  Velocity  vector  DU/TU 

RhoVec  -  Site  to  satellite  vector  in  SEZ  DU 

TempVec  -  Temporary  vector 

RHoV  -  Site  to  satellite  vector  in  IJK  DU 

RSun  -  Sun  vector  AU 

C  -  Temporary  Vector 


Constants  : 

Pi 

HalfPi 
TWOPl 

Rad  -  Degrees  per  radian 

TUDay  -  Days  in  one  TU 

AUDU  -  DUs  in  1  AU 

Coupling  : 

SUN  Position  vector  of  Sun 

MAG  Magnitude  of  a  vector 

DOT  Dot  product  of  two  vectors 

CROSS  Cross  Product  of  two  vectors 

ROTl,ROT2,ROT3  Rotations  about  1st,  2nd  and  3rd  axis 
SITE  Site  vector 

LSTime  Local  Sidereal  Tin 

NevtonR  Iterate  to  f.’nd  Eccentric  Anomaly 

AT AN 2  Arc  Tangent  function  which  resolves  quadrants 

References  : 

Escobal  pg.  369 


3.14159265358979 

1.57079632679490 

6.28318530717959 

S7.29577951308230 

0.00933809102919444 

23455.07 
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} 

PROCEDURE  Predict 


(  JD,jDEpoch,no,Ndot,Eo,Edot,lnco, 

Omegao , OmegaDot , Argpo , ArgpDot ,Mo :  Extended ; 
Lat,Lon,Alt  <  Extended} 

VAR  Rho,Az,El,Rtasc,Decl  :  Extended; 

VAR  Vis  i  Strll  ) 

CONST 

Small  t  Extended  =  0.000001; 

Pi  ;  Extended  =  3.14159265358979; 

HalfPi  ;  Extended  =  1.57079632679490; 

TwoPi  ;  Extended  =  6.28318530717959; 

Rad  ;  Extended  =  57.2957795130823; 

TUDay  ;  Extended  =  0.00933809102919444; 

AUDU  <  Extended  =  23455.07; 

VAR 

Dt, a, E0,Nu,LST, GST, Temp, SRtAsc,SDecl, Theta, Dlst, 

N,M,E, Omega, Argp  t  Extended; 

Rpqw,R,RS, VS, RhoVec, TempVec, RhoV,RSun,C  ;  Vector; 

1  s  Integer; 

BEGIN 

{  -  Initialise  values  -  } 

As  ;=  0.0; 

El  ;  =  0.0; 

Rho  i=  0.0; 

{ - Update  elements  to  new  time  - } 

Dt  i=  JD  -  JD Epoch; 
e  is  eo  +  EDot*Dt; 

Omega i=  Omegao  +  OmegaDot*Dt; 

Argp  ;=  Argpo  +  ArgpDot*Dt; 

H  t=  HO  *  No*Dt  +  NDot*Dt*Dt; 

M  t=  RealHOD(  M, TwoPi  ); 

N  »*  No  +  2.0*NDot*Dt;  (  n  is  in  rad/DAI  ,  sdot  is  over  2} 

N  ;=  N  *  TUDay;  {  convert  n  to  rad/TU} 

{  -  Newton  Rhapson  to  find  True  Anomaly  -  } 

NewtonR(  e,H,  E0,Nu  ); 

{  -  Form  PQW  position  vector  -  } 

a>  =  POWER (  1.0/(N*N)  ,  1. 0/3.0  ); 

Rpqw(4)i=  (  a*(1.0-e*e)  )  /  (1.0  +  e*Cos(  Nu  )  ); 

Rpqwj 1 ) :=  Rpqw(4)*Cos(  NU  ); 

Rpqw[2];=  Rpqw(4 j*Sin(  Mu  ); 

Rpqw( 3 ] i =  0.0; 

{ - Rotate  to  IJK - ) 

ROT3(  Rpqw  ,  -Argp  ,  TeapVec  ); 

ROT l (  TempVec,  -Inco  ,  TempVec  ); 

ROT3(  TempVec,  -Omega,  R  ); 

LSTIHE(  Lon.JD,  Let, Cat  ); 

SITE(  Lat,Alt,Lst,  RS.VS  ); 

{ - Plnd  IJK  range  vector  from  site  to  satellite - } 

FOR  1:=1  to  3  DO 

RhoV( 1 ) ;=  Rli]  -  RS(iJ; 

HAG(  Rhov  ); 

Rho;=  RhoV(4); 

{ -  Calculate  Topocentrlc  Rt  Asc  and  Declination - } 

Temp;=  SQRT(  RhoV(l J*RhoV(l)  +  RhoV(2)‘RhoV[2]  ); 

IF  A£S(  RhoV(2]  )  <  Small  THEN 
IF  Temp  <  Small  THEN 
BEGIN 

RtAsci=  999999.1; 

END 

ELSE 

IF  Rh0V[l]  >  0.0  THEN 
RtAsc;=  Pi 
ELSE 

RtASCi=  0.0 

ELSE 

RtAsc  ;=  AT  AH  2  (  RhoV(  2  ]/Tcmp  ,  RhoV(  1  ]/Tatip  ); 

IF  Temp  <  Small  THEN 

Decli=  HalfPi  {  Check  for  case  of  -90  deg  *****  } 

ELSE 

Declt=  ARCSIN(  RhoV(3)/RhoV(4]  ); 

{ - Rotate  to  8EZ - } 

ROT3(  Rhov,  LST  ,  TempVec  ); 

ROT2(  TempVec, Half Pi-Lat,  RhoVec  ); 
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{ - Check  visibility  constraints - 

{  -  Is  it  above  the  Horiion  - 

IF  RhoVec[3]  >  0.0  THBN 
BEGIN 

{ - Is  tbs  site  in  the  light,  or  the  dark? - 


SUN(  JD,RSun,SRtAsc,8Decl  ); 

LNCOM1 (  AUDU,RSun,  RSun  ); 

IP  DOT(  RSun,  RS  )  >  0.0  THEN 
Vl*i=  'Radar  Sun  1 
ELSE 
BEGIN 

{  -  Is  the  satellite  in  the  shadow  or  not?  - 

CROSS (  RSun,  R,  C  ); 

Theta t=  ArcS in (  C(4]/  <RSun[4}*R[4]>  ); 

Diet i=  R[4)*C06(  Theta  -  HalfPi  ); 

IF  Dlst  >  1.0  THIN 

Visi3  '*ye  ' 

ELSE 

Visi=  'Radar  Nits  '; 

END; 

END 

ELSE 

Vlsi=  'Not  Visible'; 

{ -  Calculate  Asiiauth  end  Elevation  - 

Tempi3  SQRT(  RhoVec( 1 ] *RhoVec [ 1 ]  +  RhoVec[2]*RhoVec[2]  ); 
IF  ABS(  RhoVec(2)  )  <  Small  THEN 
IF  Temp  <  Small  THBN 
'  BEGIN 

Wrlte<  X  ); 

As;:  999999.1; 

END 

ELSE 

IF  RhoVec[l]  >  0.0  THEN 
Axi  =  Pi 
ELSE 

Aai*  0.0 

ELSE 

Alta  AT AN 2 (  RhoVecl 2]/Tenp  ,  -RhoVec[l]/Temp  ); 

IF  (  Temp  <  Small  )  THEN 
El:=  Half Pi 
ELSE 

Eli  =  Arc31n(  RhoVec(3]/Rho  ); 

{  -  Calculate  Geocentric  Rt  Asc  and  Declination  — 

Tempi3  SQRT(  Rtl]*R[l]  +  Rt2]*Rl2J  ); 

IF  ABS(  R[2]  )  <  Small  THEN 
IF  Temp  <  Small  THEN 
BEGIN 

Write(  “G  ); 

RtAsci -  999999.1; 

END 

ELSE 

IF  R[l]  >  0.0  THEN 
RtAsci3  Pi 
ELSE 

RtAsci3  0.0 

ELSE 

RtAsci3  AT AN 2 (  R[2]/Tsmp  ,  R[l]/T«mp  )l 
IF  (  Temp  <  Small  )  THEN 
Decli=  Half Pi 
ELSE 

Decli=  ARCSIN(  R[3]/R(4]  ); 

END;  {  Procedure  Predict  } 
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PROCEDURE  DERIV 


This  procedure  calculates  the  derivative  of  the  two-body  state  vector  for 
use  with  the  Runge-Kutta  algorithm. 


Algorithm 

*  Find  the  anawer 

Author 

t  Capt  Dave  Vallado  U8AFA/DFAS 

719-472-4109  28  Aug  1989 

Inputs 

i 

ITlme 

-  Tim® 

TU 

X 

-  State  Vector 

DU,  DU/TU 

Outputs 

: 

■ 

XDOt 

-  Derivative  of  State  Vector 

DU/TU,  DU/TU2 

Locals 

t 

RCubed 

-  Cube  of  R 

Constants 

i 

None. 

1 

Coupling 

t 

None. 

References 

i 

None. 

PROCEDURE  Derlv 

(  Mine 

<  Extended; 

X 

i  Matrix; 

VAR  XDot 

i  Matrix  ); 

VAR 

R, RCubed  i  Extended; 


BEGIN 

Ri=  SQRT(  SQR(GetVal(X,l,l))  +  SQR<GetVAl(X, 2,1) )  +  SQR(GetVal(X,3,l) )  ); 
RCubed;*  R*R*R; 

( - - -  Velocity  Terns  - - - - - - - } 

AaslgnVal{  XDot,i,l,GetVal(X,«,l)  ); 

AaslgnVal(  XDot,2,l,GetVal(X,5,l)  ); 

AsalgnVeK  XDot,3,l,G*tVal(X,6,l)  ); 

{ - - -  Acceleration  Terns  - } 

AsslgnVal{  XDot, 4,1, -GetVal(X, 1,1)  /  RCubed  ); 

AsslgnVaK  XDot,5,l,-GetVal(X,2,l)  /  RCubed  ); 

AsslgnVaH  XDot,6,l,-GetVal(X,3,l)  /  RCubed  ); 

END;  {  Procedure  Derlv  } 
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PROCKDURK  PSRTACCIL 


This  procedure  calculates  the  actual  valua  of  tha  parturbing  accalaration. 


Algorithm 

Author 


<  Setup  taaporary  valuaa  ,  , 

Uaa  a  caaa  statement  to  aalact  which  parturbatlona  ara  added 
Note  aach  parturbatlon  adda  on  to  tha  pravloua  raault 

j  Capt  Dava  Vallado  USAFA/DPA8  719-472-4109  20  Sap  1990 


Inputa 

R 

V 

Time 

WhichOne 


BC 


-  Radiue  vector 

-  velocity  vector 

-  initial  time 

-  Which  perturbation  to  calculate 

-  Balliatic  Coefficient 


DU 

DU/TU 

TU 

1  2  3  4  5  ... 
kg/m2 


Outputa 

APert 


-  icrturbing  accalaration 


Locals 

rs2 

t 

Sun  radlua  vector  **2 

rs3 

- 

Sun  radius  vector  **3 

rm2 

- 

Moon  radlua  vector  **2 

rm3 

- 

Moon  radlua  vector  *»3 

r32 

- 

"a"  component  of  Radius 

r33 

- 

"a*  component  of  Radius 

r34 

- 

"a*  component  of  Radius 

r2 

- 

Radlua  vec.  nr  **2 

r3 

- 

Radius  vector  **3 

r4 

- 

Radlua  vector  **4 

r5 

- 

Radlua  vector  **S 

r7 

Radlua  vector  **7 

Beta 

Temp  -  Temporary  Real  Valua 

cho  -  Atmoapheric  Danalty 

Va  -  Relative  Velocity  Vector 

RSun  -  Radlua  Vector  to  Sun 

RHoon  -  Radlua  Vector  to  Moon 

RtAsc  -  Right  Aacanaion 

Decl  -  Declination 

1  -  Index 


DU/TU2 


DU  /  TU 

AU 

DU 

deg 

deg 


Constants 

J2 

J3 

J4 

CMS 

GMM 

OmegaRarth 

TUDay 


i 


-  Sun  Gravitational  Parameter  DU3/TU2 

-  Moon  Gravitational  Paranatar  DU3/TU2 

-  Angular  rotation  of  Karth  (Rad/TU) 

-  Days  in  one  TU 


0.00108263 

-0.00000254 

-0.00000161 

332952.9364 

0.01229997 

0.0588335906868878 

0.00933809102919444 


Coupling 

HAG 

Sun 

Moon 


Magnitude  of  a  vector 
Sun  vector 
Moon  vector 


References  < 
None. 


{ 


} 
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} 

PROCEDURE  PartACCal  (  R,V 

ITlaa 

WhlchOna 

BC 

VAR  APart 


i  Vactor ; 
i  Extandad} 
i  Intagac; 
i  Extandad} 
i  Vactor  ) } 


CONST 

OmagaEarth  s  Extandad  =  0.05883359068688786} 

TUDay  <  Extandad  =  0.00933809102919444} 

VAR 

J2,J3, J4>gas,gnm,rs2,ra2,ra3rr«3,r32>r33>r34,r2(x3>r4,r5«r7/ 
Bata»Taag5.rho»srta«c,adacl,*rtaac»*dacl  <  EXTENDED} 

Va«R8un«RMoon  t  VECTOR} 

1  i  INTEGER} 

BEGIN 

MAG(  R  )} 

HAG(  V  )} 

R2s=  r 1 4 ] *r  1 4  J } 

R3>=  R2*r[4]} 

R4|  =  R2*R2} 

R5l=  R2*R3} 

R7l=  R5*R2} 

R32i=  r[i]*r[3]} 

R33t=  R32*r[3]} 

R34t-  R32*R32| 

CASE  WhichOna  OF 

{  -  j2  Accalaratlon  -  } 

1  i  BEGIN 

J2l  =  0.00108263} 

APart[l]t=  (  (-1.5*J2*r[ll)  /  R5  )  *  (  1.0-(S.0*R32)  /  R2  )} 

APart(2)t=  (  <-1.5*J2*rl21)  /  R5  )  *  (  i.d-(5.0*R32)  /  R2  )} 

APart(3]«*  (  (-1.5*J2*r[3])  /  R5  )  *  (  3.0-(5.0*R32)  /  R2  )} 

MAG(  APart  )} 

END} 


{  -  j3  Accalaratlon  -  } 

2  t  BEGIN 

J3t*  -0.00000254} 

APart[l]t=  (  (~2.5*J3*r[l] )  /  R7  )  *  ((3.0*rr,3])-(7.0*R33)  /  R2  )} 
APart[2);=  (  (-2.5*J3»r(2J)  /  R7  )  »  ((3.0irt3J)-(7.0*R33)  /  R2  )} 
IF  ABS(  r(3)  )  >  0.0000001  THEN 

APart(3] (  (-2.5*J3*r(31)  /  R7  )  *  ((a.0*r[3])-( (3.0*R33) 

/  R2)  -  ((3.0*r2)  /  r[3}>) 

EASE 

APart(3] >  =  0.0} 

HAG(  APart  )} 

END} 


{ -  j4  Accalaratlon  - } 

3  t  BEGIN 

J4}  =  -0.00000161} 

APart[l]«=  (  (-1.875*J4*rtU)  /  R7  )  *  (1.0-((14.0*R32)/R2)+ 

( (21.0*R34)  /  R4  ))} 

APart{2] i=  (  <-1.875*J4*r(2])  /  R7  )  *  (1.0-((14.0*R32)/R2)+ 

( (21.0*R34)  /  R4  ))} 

APert(3]i=  (  (-1.875*J4*r[3))  /  R7  )  *  <5.0-((70.0*R32)/(3.0*R2))+ 
( (21.0*R34)  /  R4  ))} 

HAG(  APart  )} 

END} 


{  -  Sun  Accalaratlon  -  } 

4  i  BEGIN 

GMSls  3. 329529364805} 

ITinai=  iTina  *  TUDay} 

SUN(  ITIda  t  RSun  f  8Rt Asc , SDacl  )} 

FOR  ll=  1  to  4  DO 

RSun[ 1] RSun[l!*23455. 07003}  {  cbg  AU'a  to  DU'a  } 

RS2 j=  RSun[4]*RSun[4); 

RS3t=  RS2*RSun[4] ) 

APert[l]i=  (-GHS/R83)  * 

(r[l]-3.0*R8un[l]* 

((r[l]*R8un[l]+r[2]*RSun(2]+rl3]*RSun[3])  /  R82))} 
APsrt(2] i=  (-GM8/R83)  * 

(r [2]-3.0*R8un[2]* 

((r[l)*RSun[l]+r[2)*RSun[23+r{3]*R8unt3])  /  RB2)); 
APert(3) i=  (-GMS/R83)  * 

(r[3]-3.0*R8un(3)* 

<(r[l)*R8un[l]+rl2]*R8unl2]+r(3]*RSun[3])  /  RS2) ) ) 

HAG(  APart  )} 

END} 

{ 
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{  -  Moon  Acceleration  -  } 

5  <  BEGIN 

GMMi-  ,0.01229997; 
lTlmei=  IT lew  *  TUDay; 

MOON(  ITiBe,HMoon,MRtAec,MDecl  ); 

RM2i  =  RMoon[4]*RMoon[4] ; 

RM3:=  RM2*RHoon[4]; 

APertfl];1  (-GMM/RM3)  * 

(rll]-3.0*RMoon[l]*  .  , 

<(r[l]*RMoon[l]+rti]*RMoon[l]+r[3]*RHoont3]) 
APert[2]:=  (-GMM/RM3)  * 

<rt2]-3.0*RMoon[2}* 

( ( r [1 ]*RMoon{ 1 ]+tI 2 J*RMoon[ 2 ]+r [ 3 ]*RMoont 3 ] ) 
APert(3]i=  (-CMH/RM3)  * 

(r[3]-3.0*RMoon(31*  ,  . 

((rtll*RMoon{l]+rt3]*RMoon[3]+rt3]*RHoont3]) 

MAG(  APert  ); 

END; 


{ -  Drag  Acceleration  - ) 

6  ;  BEGIN  ,  ,  , 

Va(l]:=  Vll]  +  (0MgaBarth*r(21);  {  DU/TU  } 

Va[2];=  V(2)  -  (OMgaBarth*r[l] ) ; 

,  Va[3]t=  VC  3 ] i 

MAG(  Va  ); 

ATMOS (  R,  RhO  )J 

Teopi=  -1000.0  *  Va[4]  *  0.5«RhO*  (  1.0/BC  )*  6378137.0; 
APert[l]i*  Teep*Vatl]| 

APert[2]i=  Teep*Va[2); 

APert(3]is  Teap*Va[3]; 

MAG(  APert  ); 

END; 


{ 


- ! - solar  Acceleration 

7  :  BEGIN 

ITlmei2  ITinw  *  TUDay; 

SUM(  IT lee » R8un , SRtAac , SDecl  ); 

FOR  li=  1  to  4  DO 

RSun[l]i=  R8un[ 11*23455.07003; 


} 


{  chg  AU'e  to  DU'e  } 


Betai=  0.4; 

APert[4]i*  (4.74*-06*(1.0+Beta))/(BC*9.807); 
APertl 1] tx  (-APert[4]*RSun(ll)/R8un[4); 
APert[2]i=  (-APert[4]*RSun[2))/RSunl4J; 
APert(3]i=  (-APert[4]*RSun{3])/RSunl4); 

END; 

END;  (  Caee  } 

END;  {  Procedure  PertAccel  } 

{ 


/  RM2)); 
/  RM2)); 
/  RM2) ) ; 
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}  _ _ 

j  . - . . . 

|  PROCEDURE  TOERIV 

I 

I  This  procedure  calculates  the  derivative  of  the  state  vector  for  use  with 
j  the  Runge-Kutta  algorithm.  The  DerlvType  string  is  used  to  determine 
j  which  perturbation  equations  are  used. 

I 

|  Algorithm  t  Assign  values 

j  Check  each  value  of  Derlvtype  and  if  a  perturbation  is  needed 

I 

|  Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 

I 

I  Inputs  s 

I  Time  -  Time  TU 

I  X  -  State  Vector  DU  ,  DU/TU 

1  DerlvType  -  String  containing  XM  for  incl  perts  'TTNYHYN' 

I  BC  -  Ballistic  Coefficient.  kg/m2 

I 

I  Outputs  t 

I  XDot  -  Derivative  of  8tate  Vector  DU\TU,  DU\TU2 

j  Locals  i 

I  RCubed  -  Cube  of  X(4) 

I 

1  Constants  < 

j  None. 

I 

I  Coupling  t 

I  None . 

I 

I  References  i 

I  None. 
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PROCEDURE  PDeriv  (  X  *  Matrix* 

XTime  :  Kxtendeaj 

Der 1 vType  *  StrlO; 

BC  t  Extended) 

VAR  XDot  *  Matrix  )» 


VAR 

RCubed  i  Sxtandadj 

Ro, Vo, APert, TeepPert:  Vector) 

ii  INTEGER) 

BEGIN 

rOR  i:=  1  to  3  DO 
BEGIN 

APert(l]:=  0.0) 

Ro[i]  t=  GetVal(x,l,l)) 

Vo[i]  «=  Gatval(x, 1+3,1)) 

END) 

MAG(  RO  )) 

MAG(  Vo  ); 

APertl4]:=  0.0) 

RCubadi=  Ro[4]*Ro(41*Ro[4]> 

{ -  Valocity  Terea  - } 

AaslgnValf  XDot, 1,1,  G«tVal(X,4,l)  )) 

AssignVaK  XDot, 2,1,  GetVal(X,5,l)  )) 

Af«ignVal(  XDot, 3,1,  CetVal<X,6,l)  )) 

(  -  Acceleration  Terea  -  } 

ir  DerivType(l)  «  ’T'  THEM 

PertAccel(  Ro,Vo,ITlee,l,BC,  APert  )) 

IF  DerivType[2)  =  ' * '  THIN 
BEGIN 

PertAccel(  Ro,Vo,ITiae,2,BC,  TeepPert  )) 

AddVecf  TeepPert, APert, APert  )> 

END) 

ir  DerlvType[3]  *  'T'  THIN 
BEGIN 

PartAccelf  Ro,Vo,ITiee,3,BC,  TeepPert  )) 

AddVec(  TeepPert, APert, APert  )i 
END) 

IF  DerlvType[4]  *  'T'  THIN 
BEGIN 

PertAccel(  Ro,Vo,ITlae,4,BC,  TeepPert  )) 

AddVec(  TeepPert, APert, APart  )i 
END) 

IF  DerlvType(5]  3  'T'  THIN 
BEGIN 

PertAccelf  Ro,Vo,ITiee,S,BC,  TeepPert  )) 

AddVec(  TeepPert, APert, APert  )i 
END) 

IF  DerlvType(6]  =  'X'  THIN 
BEGIN 

PertAccel(  Ro,Vo,ITiee,6,BC,  TeepPert  )) 

AddVec(  TeepPert, APert, APert  )> 

END) 

IF  DerlvType[7]  =  'S'  THIN 
BEGIN 

PertAccel(  Ro,Vo,ITiee,7,BC,  TeepPert  )) 

AddVecf  TempPert, APert, APert  )) 

END) 

AsslgnValf  XDot,4,l,(-GetVal(X,l,l)  /  RCubed)  +  APertfl)  )) 
AsslgnValf  XDot,5,l,f-GetVal(X,2,l)  /  RCubed)  +  APert[2)  )) 
Asslgnvalf  XDot, 6,1, (-GetVal(X,3,l)  /  RCubed)  +  APert(3)  )> 

END)  {  Procedure  PDeriv  } 
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PROCEDURE  RK4 


This  procedure  is  a  fourth  order  Runge-Kutta  integrator  for  an 

N-dlmenslonal  First  Order  differential  equation.  The  user  smst  provide 
an  external  subroutine  containing  the  system  aquations  of  Motion.  Notice 
time  is  included  since  some  applications  may  need  this.  The  LAST  position 
in  DerivType  is  a  flag  for  two-body  motion.  Two-Body  action  is  used  if 
the  10th  element  is  set  to  '2',  otherwise  the  Tee  and  Mo  values  determine 
which  perturbations  to  use. 

Algorithm  t  Evaluate  each  term  depending  on  the  derivtype 
Find  the  final  answer 

Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 

Inputs  t 

iTime  -  Initial  Time 

DT  -  Step  size 

N  -  Distension  of  the  state 

DERIVTYPE  -  Which  perturbations  to  use 

BC  -  Ballistic  Coefficient 

X  -  State  vector  at  initial  time 

Outputs  i 

X  -  State  vector  at  naw  time  DU.  DU/TU 

Locals  ( 

XDot  -  Derivative  of  State  Vector 

Time  -  Time 

K  -  Storage 

TEMP  -  Storage 

J  -  Index 

TempTlme  -  Tempoary  time  storage 

Constants  i 

None. 

Coupling  « 

Derlv  Procedure  for  Derivatives  of  B.O.M. 

References  < 

James,  et  al,  "Applied  Nun  Methods*  pg.  461-444,  eqtn  pg.  463. 

BHW  pg.  414-415 


TU 

TU 


TU 

TU 


kg/n2 
DU,  DU/TU 
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} 

PROCEDURE  RK4 

(  IT  lma 

t 

Extended; 

DT 

1 

Extended; 

M 

I 

Integer; 

DarlvType 

t 

StrlO; 

BC 

t 

Extended; 

VAR  X 

t 

Matrix  ); 

VAR 

XDot,  Tamp 

;  Matrix; 

Tlme,TempTlne 

<  Extended; 

K 

t  Matrix; 

J 

t  Integer; 

BEGIN 

t - 

— 

- } 

InitHatr ix(  10, 3, X  ); 
InitMatrlxj  6,l,Teep  ); 
XnitHatrix(  6,1, XDot  ); 


IF1  DarlvTypedO)  =  '2'  THEN 
DER1V<  ITlme.X,  XDot  ) 

ELSE 

PDerlv(  X,ITl»e,DerlvType,BC,  XDot  ); 

TampTlme:=  ITlme; 

{ - Evaluate  lat  Taylor  Serlea  Tara - } 

FOR  j»=  1  to  N  DO 
BEGIN 

AaalgnVaK  X,  J,l,  Dt  *  GatVal(  XDot, 0,1)  )i 
AaalgnVaK  Temp, 0,1,  GatVal(  X,0,1)  +  0.5*GatVal(K, J,l)  ); 
END) 

Time;=  ltlme  +  Dt/2.0) 

IF  DarlvTypedO]  =  •2'  THEN 
DERIV(  Time, Temp,  XDot  ) 

ELSE 

PDerlv(  Tamp, T lma, DerlvType,BC,  XDot  ); 

{ - Evaluate  2nd  Taylor  flerlee  Tara - } 

FOR  jt=  1  to  N  DO 
BEGIN 

AaalgnVaK  X,0,2,Dt  •  GatVal(  XDot,J,l)  ); 

AaalgnVaK  Teep,j,l,GetVal(  X,0,1)  *  0.5»GetVal(K,J,2)  ); 

END; 

IF  DarlvTypedO]  »  '2*  THEN 
DERIV(  Tima, Tamp,  XDot  ) 

ELSE 

PDarlv(  Teap,TlaM,Derlvtype,BC#  XDot  ); 

{ - Evaluate  3rd  Taylor  Bar  lea  Tara - } 

FOR  jj=  1  to  N  DO 
BEGIN 

AaslgnVal(  X,0,3,Dt  *  GatVaK  XDot, 0,1)  ); 

AaalgnVaK  Temp, 0,1,  GetVal(  X,0,1)  +  GatVal(K,J,3)  ); 

END; 

TempTimei=  Tempt lma  +  Dt; 

IF  DarlvTypedO)  =  '2'  THEN 

DERIV(  Te»pTli*e,T#«p,  XDot  ) 

ELSE 

_'Darlv(  T«mp,TeapTlae,DerlvType,3C,  XDot  ); 

{  -  -  Update  the  State  vector  - } 

FOR  j;=  l  to  N  DO 

AsslgnVaK  X,0,l,GetVal(  X,0,1)  + 

(  GetVal(K, J,l)  +  2.0*(  GatVal(X,J,2)+GatVal(K,J,3)  )  + 
Dt *GatVal(  XDot, 0,1)  )  /  6.0  ); 

DelMatrlx)  K  ); 

DelMatrlxj  Tamp  ); 

DelMatrlxj  XDot  ); 

END;  {  Procedura  RX4  } 

{ 
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PROCBDURI  ATMOS 


This  procedure  finds  ths  atmospheric  density  at  an  altitude  above  an 
oblate  earth  given  the  position  vector  in  the  Geocentric  Equatorial 
frame.  The  position  vector  is  in  DU' a  and  the  density  is  in  gm/cm**3. 


Algorithm  <  Find  initial  valuea 

Loop  to  find  the  latitudes 

Calculate  the  density  through  a  cascading  IF  statement 
Author  i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  20  Sep  1990 


inputs 

R 


t 

-  GEC  Position  vector 


DU 


Outputs 

Rho 


i 

-  Density 


kg/m* *3 


Locals  i 

Rc 

Height 

Alt 

OldDelta 
DeltaLat 
GeoDtLat 
GeoCnLat 
TwoFMlnusF2  - 
OneMinuaF2  - 
Delta 
Temp 
RSqrd 
SinTemp 
RhoMom 
H 
1 


Range  of  site  v.r.t.  earth  center 
Height  above  earth  v.r.t.  site 
Altitude  above  earth  v.r.t.  site 
Previous  value  of  DeltaLat 
Dlff  batveen  Delta  and  Geocentric  lat 
Geodetic  Latitude 
Geocentric  Latitude 
2*F  -  F  squared 
(  l  -  F  )  squared 

Declination  angle  of  R  in  IJK  system 
Dlff  betveen  Geocentric/Geodetic  lat 
Magnitude  squared 
Sine  of  Teap 

Nominal  density  at  particular  alt 

Scale  Height 

index 


DU 

DU 

km 

rad 

rad 

-Pl/2  to  Pl/2  rad 
-Pl/2  to  Pi/2  rad 


rad 

rad 


gm/cm**3 

km 


Constants 

Pi 

Flat 

REarthXm 


Flatennlng  of  the  Barth 
Barth  equatorial  radius 


3.14159265358979 

0.003352810664747352 

6378.137 


Coupling 

MAG 


Magnitude  of  a  vector 


References 

Bscobal 


pg.  398-399  (  Conversion  to  Lat  and  Height  ) 


} 
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} 

PROCEDURE  ATMOS 


t  Vector; 

:  Extended  ); 


(  R 

VAR  Rho 

CONST 

Pi  :  Extended  =  3.14159265359; 

Flat;  Extended  =  0.003352910664747352; 

VAR 

Rc,  Height,  OldDelta,  DeltaLat,  GeoDtLat,  TvoFHlnu»F2,  SinTenp, 
OneMinusF2,  Delta,  RSqrd,  Tenp,  GeoCnLat,  h,  Alt,  RhoNom  t  Extended; 
•i  t  Integer; 

BEGIN 

{  -  Initialise  value*  -  } 

MAG(  R  ); 

TwoFHlnu*F2i=  2.0*Flat  -  Flat*Flat; 

OneMinusF2  !  =  POWER (  1.0-Flat, 2.0  ); 

{ - Set  up  initial  latitude  value  - } 

Delta :=  ArcTan(  R[3)  /  80RT(  R[1]*R[1]  +  R(2)*R[2]  )  ); 

IF  ABS(  Delta  )  >  Pi  THEN 

Delta :=  RealM0D(  Delta, Pi  ); 

GeoCnLat <=  Delta; 

01dDelta<=  1.0; 

DeltaLat t=  10.0; 

RSqrd  t-  R[4]*R(4] ; 

{  -  Iterate  to  find  Geocentric  and  Geodetic  Latitude  -  } 

1«=  1; 

WHILE  (  ABS(  OldDelta  -  DeltaLat  )  >  0.00001  )  and  (  i  <  10  )  DO 
BEGIN 

OldDelta t =  DeltaLat; 

Rc  «=  SQRT(  (  1.0-TwoFMlnu«F2  )  / 

(  1 . 0-TvoFMlnu*F2*COS(GeoCnLat ) *COS (GeoCnLat )  )  ); 
GeoDtLat :=  ArcTan(  TAN(CeoCnLat)  /  On*Mlnu*F2  ); 

Tenp  t=  GeoDtLat-CeoCnLat; 

SlnTempi=  SIN(  Teap  ); 

Height  i=  SQRT{  RBqrd-Rc*Rc*SlnT*np*SlnTeap  )  -  Rc*COS(T#rap) ; 
DeltaLat : =  ARCSIN(  Helght*81nTenp  /  R[4)  ); 

GeoCnLat i =  Delta  -  DeltaLat; 

INC<  1  ); 

END;  {  While  } 

IF  1  >=  10  THEN 

WriteLn(  'IJXtoLatLon  did  NOT  converge  1  ); 
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} 


ALT:*  Helght*6378.137; 

{  -  Determine  density  bated  on  altitude  - 

IP  Alt  >*  800  THEN 
BEGIN 

H  «=  130.81 
RHONOMt*  4.262E-17; 

RHO  :*  RHONOM*EXP( ( 800. 0-ALT )/H) ; 

END 

ELSE 

IF  Alt  >=  700  THEN 

BEGIN 

H  I*  105.3; 

RHONOMt*  1.2168-16; 

RHO  :*  RHONOM* EXV(( 700. 0-ALT )/H) ; 

END 

ELSE 

IF  Alt  >*  600  THEN 
BEGIN 

H  l=  91.0; 

RHONOMt*  3.818E-16; 

RHO  :*  RHONOM*BXP( (600 . 0-ALTJ/H) ; 

END 

ELSE 

IF  Alt  >*  500  THEM 
BEGIN 

H  **  81.9; 

RHONOMt*  1. 316K-15; 

RHO  t*  RHONOM*EXP( (500. 0-ALT )/H) ; 

END 

ELSE 

IF  Alt  >=  400  THEN 
BEGIN 

H  :=  73.2; 

RHONOMt*  5.192E-15; 

RHO  t*  RHONOM»t»((400,0-ALT)/H); 

END 

ELSE 

IF  Alt  >*  300  THEN 
BEGIN 

H  t*  61.2; 

RHONOMt*  2.653E-14; 

RHO  t*  RHOMOM*BXP((300.0-ALT)/H); 

END 

ELSE 

ir  Alt  >*  250  THEN 
BEGIN 

H  t*  52.6; 

RHONOMt*  7.316E-14; 

RHO  i«  RH0M0M*E8F( ( 250. 0-ALT )/K); 

END 

ELSE 

IF  Alt  >*  200  THEN 
BEGIN 

H  1*  40. I | 

RHONOMt*  2.706B-13; 

RHO  t*  RHONOM*BXP( ( 200. 0-ALT )/H ) ; 

END 

ELSE 

IF  Alt  >*  150  THEN 
BEGIN 

H  i«  24.1; 

RHONOMt*  2.141E-12; 

RHO  t*  RHONOM»8XP( { 150. 0-ALT) /H); 

END 

ELSE 

IF  Alt  >*  130  THEN 
BEGIN 

H  l*  16.1; 

RHONOMt*  8.4848-12; 

RHO  t*  RHONOM*BXP((130.0-ALT)/H); 
END 
ELSE 
BEGIN 

H  i=  8.06; 

RHONOMt*  9.6618-11; 

RHO  l*  RH0N0M*8XP( (110. 0-ALT )/H) ; 
END; 

END;  (  Procedure  Atmos  } 

{ 
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PROCEDURE  CHEBY 


This  procedure  calculates  a  CHBBYCHBV  expansion  for  the  atmosphere. 

Given  an  altitude  above  the  Barth's  surface,  it  will  find  the  pressure  and 
density  at  that  altitude  using  a  Chebyshev  polynomial.  Calculations  are 
accomplished  in  metric  units,  and  the  final  answers  are  converted  to 
English  units,  as  described  below. 

The  model  is  only  valid  from  0  to  200  km  (656,000  ft)  altitude. 


Algorithm 


Author 


Inputs 

Alt 

Outputs 

PAlt 

RhoAlt 

Locals 


i  Convert  the  altitude  to  km 
Assign  the  pressure  coeff  based  on  altitude 
Calculate  the  pressure 
Assign  the  density  coeff  based  on  altitude 
Calculate  the  denlsty 
Convert  to  ENGLISH  units 

i  C2C  Gandhi  U3AFA  719-472-4109  28  NOV  1988 

Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  28  Aug  1990 


-  Altitude  above  earth's  surface,  ft 


-  Pressure  at  altitude  lbf/in**2 

-  Density  at  altitude  lbm/ft**3 


Constants  : 

None. 

Coupling  t 

None. 

References  i 

None. 

-  j 


PROCEDURE  CHEBY  (  ALT  i  Extended; 

VAR  PALT, RHOALT  ,  Extended  ); 

VAR 

Z,  Zl,  Sum,  P0  ,  X,  Nu,  Part,  LnR,  R,  RhoO  t  Extended; 

C, A  i  ARRAY l 1 . . 15 )  of  Extended; 
k  i  INTEGER; 

BEGIN 

{  -  Convert  altitude  to  kilometers  -  ) 

Z  i=  Alt  *  0.0003048; 

{ 
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IF  Z  <=  80.0  THEN 
BEGIN 

{ - Chebychev  nodal  for  altitude*  of  80  km  or  laaa - } 

{  - -  Define  initial  and  aero  altitude  preeaura  conatant*  -  } 


SUH 

:  = 

0.0; 

Z1 

;  = 

80.0; 

P0 

:  = 

101325.0; 

Define  the  preaaure  ratio  coefficient* 

A[l) 

-11.385925; 

A[  2 ) 

t  = 

-5.6837011; 

A[3) 

t  = 

0.052666476; 

A[4] 

:  = 

-0.077884294; 

ACS) 

-0.11004083; 

A[6] 

i  = 

0.017572339; 

A  C  7 ) 

0.0048546337; 

AC  8  ] 

;  = 

0.0017694805; 

A[9J 

;  = 

-0.0018185298; 

AC  10) 

l  = 

-0.0026635086; 

A[  11) 

1 = 

0.0035685433; 

At  12) 

i  - 

-0.00082257517; 

AC  13 ) 

t  = 

-0.0010363683; 

At  14) 

;  = 

0.00057053477; 

At  15 ) 

t  = 

-0.00019023078; 

END 

ELSE 

BEGIN 

{ - Chabychav  nodal  for  altitude*  of  80  to  200  km - } 

{  —  Define  initial  and  aero  altitude  preeaura  conatant*  -  } 

SUH  t=  0.0; 

Z1  ;*  200.0; 

P0  ;=  101325.0; 


— — 

—  Define  the  pressure  ratio  coefficients 

At  1  ] 

|  3 

-24.475069; 

At  2) 

l  S 

-10.685861; 

At  3) 

J  3 

2.2622605; 

At  4) 

1  ** 

0.634333981 

A[  5  J 

1  = 

-0.27948959; 

At  ) 

{8 

-0.31548574; 

At  7 ) 

JS 

0. 090751361) 

At  8 ) 

|3 

0.18530467; 

A[9) 

)  3 

-0.095325843; 

A[  10 ) 

|  3 

-0.050214309) 

At  11) 

lS 

0.045101378; 

At  12 ) 

|  3 

0.0088997472; 

At  13) 

8s 

-0.018935899; 

A[  14  ] 

|S 

0.0035690821; 

A[15) 

Is 

-0.0063989880; 

END; 


{ - Define  X  aa  a  function  of  the  altitude  ratio - } 

X  ;=  2.0  *  Z/Zl  -  1.0; 

{  — - - Define  Nu  aa  a  function  of  X - } 

Nu  i*  2.0  *  X; 

{  -  Define  the  Chebyahev  Polynomial*  aa  function*  of  Nu  —  } 

C [ 2 ]  ;=  Nu; 

C[ 3 ]  t=  Nu*Nu  -  2.0; 

FOR  ki=  4  to  15  DO 

C(k]  t=  Nu  *  Clk-1)  -  C[k-2); 

{  -  Sun  all  part*  of  the  Chebyahev  expanaion  atmoaph’ric  model-  } 
FOR  k;=  2  to  15  DO 
BEGIN 

PART  t=  A( k 1  *  C[k  ] ; 

SUH  SUH  +  PART; 

END; 


{ - Solve 

LNR  ;=  0.5  *  (A[ 1  ]  + 
R  1=  EXP(LNR) ; 

PALT  s=  R  *  P0; 


for  the  prasaure  at  altitude  - 

SUH); 


—  } 
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IF  Z  <=  80.0  THEN 
BEGIN 

{ - Chebychev  nodal  for  altitudes  of  80  km  or  lass - } 

{  -  Define  initial  and  aero  altitude  density  constants  —  } 


SUM 

:  = 

0.0; 

Z1 

s  = 

80.0; 

RHOO 

:  = 

1.2250; 

— 

Define  the  density  ratio  coefficients 

All] 

;  = 

-10.960632; 

A(  2] 

1  = 

-5.5717132; 

A[3] 

:  = 

0.099116555; 

AC  4 ) 

:  = 

0.061044847; 

A[5] 

5  = 

-0.14304157; 

A(6] 

;  = 

0.0029494088; 

A(7) 

;  = 

0.0058789604; 

A  [  8 } 

?  = 

0.0020421324; 

At  9  J 

:  = 

0.0071033206; 

At  10  ] 

t  = 

-0.0010314086; 

At  11] 

x = 

0.0034100737; 

A[  12  ] 

0.0041764325; 

At  13 ) 

i  = 

-0.0039151559; 

At  14] 

:  = 

0.0011227828; 

At  15 ) 

;  = 

-0.0015751053; 

END 

ELSE 


BEGIN 

{  -  Define  initial  and  aero  altitude  density  constants  —  } 

SUM  »  =  0.0; 

Z1  :=  200.0; 


RHOO 

1  = 

1.2250; 

— 

Define  the  density  rati)  coefficients 

All] 

:  = 

-25.415229; 

A[  2  ] 

I  s 

-11.684380; 

At  3  ] 

J  = 

1.8721406; 

At  4] 

:  = 

0.81660876; 

A(  5] 

J  s 

-0.093811118; 

A(6) 

•  ~ 

-0.30155735; 

A(7] 

J  = 

-0.077593291; 

At  8 ) 

X  s 

0.21640168; 

At  9  ] 

j  = 

-0.034918422; 

At  10) 

X  - 

-0.070126799; 

Alii) 

1  = 

0.036014616; 

At  1 2 ) 

1  s 

0. 014951351; 

A(  13  ] 

1  = 

-0.021450283; 

A[  14  J 

1  - 

-0.0012497995; 

A(  15 ) 

0.018421866; 

END; 

{  -  Define  X  as  a  function  of  the  altitude  ratio  -  } 

X  :=  2.0  *  Z/Zl  -  1.0; 

{ - Define  Nu  as  a  function  of  X - } 

Nu  i=  2.0  *  X; 

{  -  Define  the  Chebyshev  Polynomials  as  functions  of  Nu  —  } 

C[ 2)  t=  Nu; 

C( 3]  ;=  Nu*Nu  -  2.0; 

FOR  k i =4  to  IS  DO 

C[k]  :=  Nu  *  Clk-1]  -  C[k-2]» 

{  -  Sum  all  parts  of  the  Chebyshev  expansion  atmospheric  model  } 
FOR  k:=  2  to  15  DO 
BEGIN 

PART  ;=  A(k]  *  C(k); 

SUM  SUM  +  PART; 

END; 


{ - Solve  for  the  density  at  altitude - } 

LNR  :=  0.5  *  (A(l]  +  SUM); 

R  i=  EXP(LNR); 

RHOALT  i=  R  *  RHOO; 

{  —  Convert  pressure  i  density  from  metric  units  to  English  units  } 

{  —  (N/(ra*m)  ==>  lbf/ln**2;  kg/m«*3  =»>  lbm/ft**3)  -  } 

PAlt  i-  PAlt  *  0.000145; 

RhoAlt  ;=  RhoAlt  *  0.062429507; 

END;  {  Procedure  Cheby  } 


A-»S 


APPENDIX  B 


PASCAL  SOURCE  CODE 


MATHEMATICAL  ROUTINES 


UNIT  MATH; 


(* 

(* 

(* 

(* 

(* 

<* 

(* 

<* 

(* 

{* 

(* 

(* 

(* 

(* 

(* 

(* 

(* 

(* 

(* 

<* 

(* 

(* 

(* 

(* 

(* 

<* 

(* 

(* 

(* 

(* 

(* 

(* 

(* 

<* 

(* 

(* 

<* 

<* 

<* 


Module  -  HATH. PAS  *) 

*> 

This  £11*  contains  most  of  tbs  math  procedc.es  and  functions.  *) 

*) 

*****************  noticb  op  GOVERNMENT  ORIGIN  ****************  *) 

*) 

This  software  has  bean  developed  by  an  employee  of  the  United  States  *) 

Government  at  the  United  States  Air  Force  Academy,  and  is  therefore  *) 

a  work  of  the  United  States,  and  is  NOT  subject  to  copyright  protection  *) 

under  the  provisions  of  17  U.S.C.  105.  AMT  use  of  this  work,  or  *) 

inclusion  in  other  works,  must  comply  with  the  notice  provisions  of  *) 
17  U.S.C.  403.  *) 

*) 

****************************************************************  *) 

*) 

Current  t  30  Jan  91  Capt  Dave  Vallado  VERSION  3.0  *) 

*) 

Changes  i  25  Jan  91  Capt  Dave  Vallado  *) 

Update  forsuittlng  and  mlac  fixes  *) 

20  Sep  90  Capt  Dave  Vallado  *) 

Add  roots  solvers  and  fix  small  *) 

20  Apr  90  Capt  Dave  Vallado  VERSION  2.0  *) 

Updated  version  *) 

24  Jan  90  Capt  Dave  vallado  *) 

Change  Matrix  structure  *) 

4  Dec  69  Capt  Dave  Vallado  *) 

Added  DOG  function  *) 

8  Sep  88  Capt  Dave  Vallado  *) 

Version  1.0  *) 

27  Jun  88  Capt  Dave  Vallado  *) 

Fixes  to  NAG  calls  in  misc  procedures  *) 

17  Apr  88  Capt  Dave  Vallado  *) 

Upgrade  to  Turbo  4.0  *) 

23  Nov  87  Capt  Dave  Vallado  *) 

Incorporated  comments  for  each  procedure  *) 

*) 

-  *> 


INTERFACE 


(* 


*) 


TYPE 

Vector  =  ARRAY (1.. 4]  of  Extended; 

Str64  =  STRING! 64 ] ; 


Intarray  •  array [1.. 6]  of  Integer; 


HatrixDataFtr  = 
Matrixtata  - 


MatrlxPtr 


Matrix 


'MatrixData; 

RECORD 

Index  i  Integer; 

Number  i  Extended; 

Next, last  t  MatrixDataPtr; 

END; 

RECORD 

Nu*Rov»,NumCols  i  Integer; 

DPtr  i  MatrixDataPtr; 

Head, Tall  t  MatrixDataPtr; 

END; 

‘HatrlxPtr; 


( _ — 

- Misc 

functli 

3ns  for  PASCAL  - 

- } 

Function 

SGN 

( 

XVal 

t 

Extended  ) 

:  Extended; 

Function 

RealMOD 

( 

xval, 

Kodby  < 

Extended  ) 

i  Extended; 

Function 

Power 

( 

Base, 

Pwr  i 

Extended  ) 

i  Extended; 

Function 

Log 

( 

xval 

l 

Extended  ) 

t  Extended; 

Function 

Min 

( 

X,  Y 

l 

Extended  ) 

i  Extended; 

Function 

Max 

( 

X,  Y 

t 

Extended  ) 

t  Extended; 

Procedure 

Plane 

( 

Xl,yl,al,x2,y2,z2,x3,y3,z3t 

Extended; 

VAR  a,b,c,d  i  Extended  ); 
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{  -  Trigonometric  Functions  -  } 


Function  Tan 

(  xval 

>  Extended 

)  I 

Extended; 

Function  Cot 

,(  XVal 

i  Extended 

)  * 

Extended; 

Function  Csc 

(  XVel 

t  Extended 

)  s 

Extended; 

Function  See 

(  XVal 

:  Extended 

)  t 

Extended) 

Function  ATan2 

(  SlnValue,  CosValue 

t  Extended 

)  X 

Extended; 

Function  ArcSln 

(  XVal 

>  Extended 

)  t 

Extended; 

Function  ArcCos 

{  xval 

>  Extended 

)  s 

Extended; 

Function  Cosh 

(  xval 

:  Extended 

)  : 

Extended) 

Function  ArcCosh 

(  XVal 

>  Extended 

)  i 

Extended; 

Function  Slnh 

(  xval 

t  Extended 

)  t 

Extended) 

Function  ArcSinh 

(  XVal 

t  Extended 

)  s 

Extended; 

Function  Tanh 

(  XVal 

t  Extended 

)  : 

Extended; 

Function  ArcTanh 

(  XVal 

s  Extended 

>  « 

Extended) 

i - 

Function  DOT 

(  Vecl,V»c2 

t  Vector 

)  » 

Extended) 

Procedure  CROSS 

(  Vecl,Vec2 

i  Vector) 

VAR  OutVec 

i  Vector 

)> 

Procedure  MAG 

(  VAR  Vac 

>  Vector 

)> 

Procedure  NORM 

(  Vac 

t  Vector; 

VAR  OutVec 

i  Vector 

)> 

Procedure  R0T1 

(  Vac 

:  Vector) 

XVal 

s  Ixttndtd 1 

VAR  OutVec 

■  Vector 

)> 

Procedure  R0T2 

(  Vac 

i  Vector; 

xval 

i  Ext«ndid; 

VAR  OutVec 

>  Vector 

)» 

Procedure  ROT3 

(  Vac 

i  Vector) 

XVal 

t  Extended; 

VAR  OutVec 

i  Vector 

)> 

Procedure  ADDVEC 

(  Vecl,Vec2 

i  Vector; 

VAR  OutVec 

i  Vector 

>i 

Procedure  ADD3VEC 

(  Vecl,Vec2,Vec3 

r  Vector; 

VAR  OutVec 

>  Vector 

>> 

Procedure  LNC0M1 

(  * 

:  Extended) 

Vac 

>  Vector; 

VAR  OutVec 

>  Vector 

)> 

Procedure  LNC0M2 

(  A1,A2 

i  Extended) 

Vecl,Vec2 

t  Vector) 

VAR  OutVec 

>  Vector 

>; 

Procedure  LNC0H3 

(  A1|A2/A3 

)  Extended) 

Vecl,Vec2,Vec3 

>  Vector; 

VAR  OutVec 

i  Vector 

>> 

Procedure  ANGLE 

{  Vecl ,Vec2 

>  Vector) 

VAR  Theta 

i  Extended 

)> 

B-i  i 


{ - 

-  Analytic  routines  - 

- } 

Procedure  Quadratic 

(  a,b,c 

»  Extended) 

VAR  Rlr,Rli,R2r,R21 

t  Extended 

>> 

Procedure  Cubic 

(  a,b,c,d 

s  Extended; 

VAR  Rlr,Rll,R2r,R21,R3r 

,R3it  Extended 

)> 

Procedure  Quartlc 

(  a,b,o,d,e 

i  Extended) 

VAR  Rlr,RU,R2r,R2i,R3r 

,R3i, 

R4r,R4i 

i  Extended 

)> 

/ 

l  - - 

Hid  IX  UpttXaC  ions 

- - - - -  J 

Procedure  InltMatrix 

(  Rows , Cols 

i  Integer) 

VAR  A 

i  Matrix 

)t 

Procedure  DelMatrlx 

(  VAR  A 

i  Matrix 

)> 

Function  QetVal 

(  VAR  A 

t  Matrix) 

Row, Col 

t  Integer 

)« 

Extended) 

Procedure  AssignVal 

(  VAR  A 

t  Matrix) 

Row, Col 

i  Integer) 

Number 

>  Extended 

>» 

Procedure  MatMuit 

(  Katl,Mat2 

t  Matrix) 

Natlr,Matlt,Hat2c 

i  Integer  ) 

VAR  Kat3 

i  Matrix 

)> 

Procedure  MatAdd 

(  Hatl,H«t2 

i  Matrix) 

Matlr,Nitlc 

i  Integer  ) 

VAR  Nat3 

s  Matrix 

)l 

Procedure  MatTrans 

(  Natl 

t  Matrix) 

Hatlr,Hatlc 

■  integer  t 

VAR  Nat 2 

s  Matrix 

)» 

Procedure  LUDeComp 

(  VAR  VI 

i  Matrix) 

VAR  index 

i  Ir.tarray) 

Order 

i  Integer 

)) 

Procedure  LUBkSub 

(  LU 

i  Matrix) 

index 

t  Intarray) 

Order 

■  Integer) 

Var  B 

>  Matrix 

>) 

Procedure  Hatlnverae 

(  Nat 

t  Matrix) 

Order 

i  Integer) 

VAR  Natlnv 

i  Matrix 

)> 

Procedure  PrlntHat 

(  Natl 

i  Matrix) 

Title 

i  Str64 

>) 

Function  Determinant 

(  Natl 

i  Matrix) 

Order 

i  Integer 

) 

Extended) 

IMPLEMENTATION 

- - - 

*) 

(*  -  *) 

{ 
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} 

I 

I  FUNCTION  SON 

I 

I  This  Function  determines  the  sign  of  •  number . 

I 

I  Algorithm  i  Sat  tha  function  to  1.0  if  positive,  -1.0  if  nagatlva 
I  Author  :  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  18  Sap  1990 

I  Inputs  : 

I  XVal  -  Value  to  determine  sign  of 

j  Outputs  < 

I  SGN  -  Result  +1  or  -1 

I 

I  Locals  t  t 
I  None. 

I 

I  Coupling  s 

I  None . 

I 

- } 

FUNCTION  SGN  (  XVal  :  Sxtended  )  t  Extended; 

VAR 

Temp  :  EXTENDED; 

BEGIN 

IF  XVal  >0.0  THEN 
Tempt3  1.0 
ELSE 

Tempt3  -1.0; 

SGNt3  Temp; 

END;  (  Function  SGN  } 


( - 

I 

I  FUNCTION  RealHOD 

I 

I  This  Function  performs  the  MOO  operation  for  REALS. 

I  Algorithm  t  Assign  a  temporary  variable 

I  Subtract  off  an  integer  number  of  values  while  the  xval  is 

I  too  large 

I  Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

|  i 

I  Inputs  t 

\  XVal  -  Value  to  MOD 

I  ModBy  -  Value  to  MOD  with 

I  Outputs  t 

I  RealHOD  -  Result  -ModBy  <=  Answer  <=  +ModBy 

I  Locals  t 

I  TempValue  -  Temporary  Extended  value 

I  Coupling  t 

I  None . 

I  _ 

FUNCTION  RealMOD  (  XVal,Hodby  t  Extended  )  t  Extended; 

VAR 

TempValue t  Extended; 

BEGIN 

TempValue  :  =  XVal; 

WHILE  ABS(TempValue)  >  ModBy  DO 

TempValuet3  TempValue  -  INT(XVal/ModBy)*ModBy; 

RealHODt3  TempValue; 

ENDi  {  Function  RealMOD  } 

{ 


B-l 


} 

{ 


FUNCTION  POWER 


I  This  Function  performs  the  raising  of  a  bass  to  a  power.  Motlca  tha  IF 
i  statement  to  ellainate  problems  such  as  a  nsgativs  base,  or  a  bass  squal 
I  to  0.0. 

I 

I  Algorithm  t  If  tha  bass  is  positive,  calculata  tha  answar 
I  Otherwise,  writs  an  arror 

I  Author  :  Capt  Dave  Vallado  U SAFA /DP AS  719-472-4109  12  Aug  1988 

I  Inputs  i 

I  Bass  -  Bass  valua 

I  Pwr  -  Powar  to  raisa  bass  to 

I 

I  Outputs  ! 

I  Power  -  Result 

I 

I  Locals  t 

I  Nona. 

I 

I  Coupling  i 

I  Nona. 

I 

- } 

FUNCTION  Power  {  Base,  Pwr  t  Extended  )  t  Extended; 

BEGIN 

IF  Base  >  0.0  THEN 

Power  >-  Exp(  Pwr  *  Ln(  Base  )  ) 

ELSE 

BEGIN 

Wrlteln(  'Error  in  Powar  with  bass  =  'these,1  and  Pwr  »  ' ,Pwr  ); 

END; 

END;  {  Function  Power  } 


{  - 

I 

I  FUNCTION  LOG 

I 

I  This  Function  performs  tha  LOG  base  10  problaai. 

I  Algorithm  i  if  tha  x  is  positiva,  calculata  tha  answer 
I  Otherwise,  sat  the  answar  to  0.0 

I  Author  i  Haj  Toai  Riggs  USAFA/DFAS  719-472-4109  4  Dec  1989 

I  Inputs  t 

I  X  -  valua  to  taka  the  Log  base  10  of 

I  Outputs  : 

|  Log  -  Result 

I  Locals  ; 

I  Nona. 

I 

I  Coupling  ; 

I  None. 

I 

FUNCTION  LOG  (  XVal  ;  Extended  )  ;  Extended; 

Const 

Lfac  ;  Extended  =  0.4342944819;  {l.0/ln(10)} 

BEGIN 

IF  XVal  >0.0  THEN 

Log  »=  Lfac*ln(XVal) 

ELSE 

Log  s=  -1.0a37; 

END;  {  Punction  Log  } 

{ 
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} 

{ - - - 

I 

j  FUNCTION  NIN 

I  This  Function  determines  tha  Minimum  of  2  valuas. 

I 

I  Algorithm  s  If  the  x  is  lass  than  y,  sat  min  to  x 
I  otherwise,  sat  min  to  y 

i 

I  Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I 

I  Inputs  > 

I  X  -  Value  number  1 

I  V  -  Value  muiber  2 

I  Outputs  s 

i  Hin  -  Minimum  of  x  or  y 

1  Locals  > 

I  Nona . 

I 

I  Coupling  < 

I  Nona. 

- } 

FUNCTION  Min  (  X,  T  i  Extended  )  t  Extended; 

BEGIN 

IF  X  <  Y  THEN 
Min  ;  =  X 
ELSE 

Min  ;  =  V; 

END;  {  Function  Nln  } 


(  - 

I 

I  FUNCTION  MAX 

This  Function  determines  tha  aiaxlmuai  of  2  values. 

Algorithm  ;  If  tha  x  is  sure  than  y,  set  max  to  x 
otherwise,  set  max  to  y 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

Inputs  i 

!  X  -  Value  number  1 

I  Y  -  Value  number  2 

I 

I  Outputs  I 

I  Max  -  Minimum  of  x  or  y 

I  Locals  ; 

I  Nona. 

! 

I  Coupling  ; 

)  Nona . 

I 

- } 

FUNCTION  Max  (  X,  Y  t  Extended  )  :  Extended; 

BEGIN 

IF  X  >  Y  THEN 
Max  i=  X 
ELSE 

Hax  «=  Y; 

END;  {  Function  Hax  } 

{ 
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} 

{ - 

I 

I  PROCEDURE  PUNE 

I 

I  This  procedure  calculates  the  equation  of  a  plane  given  3  points 
I  ptl  -  xl,yl,zl,  pt2  -  x2,y2,x2,  pt3  -  x3,y3,s3  ,  and  outputs  the 
I  abed  variables  describing  the  plane.  NOTE  that  the  general  equation 

I  of  a  plane  is  defined  here  ass  ax  +  by  +  cs  +  d  =  0  and  the  values 

I  are  obtained  by  solving  the  ordered  determinant  x  y  a  1 

I  xl  yl  al  1  =0 

I  x2  y2  s2  1 

I  x3  y3  a3  1 

1  Algorithm  t  find  the  line  differences  for  each  set  of  points 
I  Calculate  the  coefficients  of  the  plane 

I  Author  I  Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  12  Aug  1988 

I  Inputs  s 

I  xl,yl,al  -  point  8  1 

I  X2,y2,a2  -  point  f  2 

I  x3,y3,z3  -  point  •  3 

I  Outputs  s 

I  a,b,c,d  -  constants  for  the  equation  of  the  plane 

I  Locals  s 

I  z23 

I 

I  Coupling  i 

I  None. 


PROCEDURE  Plane  (  xl,yl,zl,x2,y2,z2,x3.y3.z3s  Extended; 

VAR  a.b'Cfd  t  Extended); 

VAR 

Z23,y23,x23,yz23,yz32,xz23,xz32,xy23,xy32  s  Extended; 

BEGIN 

z23i  =  z2-z3» 
y23t=  y2-y3; 

X23i=  x2-x3; 

yz23t-  y2*a3; 
yz32s=  y3*z2; 

xz23t=  x2*z3;  1 

xz32i=  x3*z2; 
xy23i=  x2*y3; 
xy32i=  x3*y2; 

ai=  yl*z23  -  zl*y23  ♦  ys23  -  ys32; 

bi=  xl*z23  -  zl*x23  +  xs23  -  xa32; 

cs=  xl*y?3  -  yl*x23  +  xy23  -  xy32; 

ds=  xl*(yz23  -  yz32)  -  yl*(x*23-xz32)  t  zl*(xy23  -xy32); 

END;  {  Procedure  Plane  } 


} 

I 

I  FUNCTION  TAM 

I 

I  This  Function  finds  the  tangent  of  an  angle  in  radians. 

j  Algorithm  :  If  tha  absoluta  valua  of  XVal  is  saro«  sat  tan  to  infinity 
j  otherwise,  find  tha  answer  using  the  sina 

I 

I  Author  i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  20  Sap  1990 

I  Inputs  > 

I  XVal  -  Angla  to  taka  Tangent  of  rad 

I  Outputs  i 

I  Tan  -  Result 

I  Locals  t 

I  Temp  -  Temporary  Real  variable 

I  Constants  t 

I  Inlfinlty  -  Valua  to  represent  infinity 

I  Small  -  Tolaranca  valua 


FUNCTION  Tan  (  XVal  i  Extended  )  s  Extended) 

CONST 

Infinity  i  Extended  =  999999.9) 

Small  )  Extended  *  0.000001) 

VAR 

Temp  t  EXTENDED) 

BEGIN 

Temp  i  =  Cost  XVal  )) 

IF  ABS(  Temp  )  <  Small  THEM 
Tan  )-  Infinity 
ELSE 

Tan  t=  Sln(  XVal  )  /  Temp) 

END)  {  Function  Tan  } 


I  FUNCTION  COT 

I 

I  This  Function  finds  the  Cotangent  of  an  angle  in  radians. 

I  Algorithm  )  if  the  absolute  valua  of  XVal  is  sero,  set  cot  to  infinity 

I  otherwise,  find  the  answer  using  the  tangent 

I  Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 

I  Inputs  i 

I  XVal  -  Angle  to  take  Cotangent  of  rad 

I  Outputs  I  I 

I  Cot  -  Result 

I 

I  Locals  t 

I  Temp  -  Temporary  Real  variable 

I  Constants  > 

I  Inlfinlty  -  Value  to  represent  infinity 

I  Small  -  Tolerance  value 

I 

- -  —  } 

FUNCTION  Cot  (  XVal  t  Extended  )  t  Extended) 

CONST 

Infinity  t  Extended  -  999999.9) 

Small  s  Extended  -  0.000001) 

VAR 

Temp  s  EXTENDED) 

BEGIN 

Temp:=  Tan(  XVal  )) 

IP  ABS(  Temp  )  <  Small  THEN 
Cot  i-  Infinity 
ELSE 

Cot  i-  1.0  /  Temp; 

END)  {  Function  Cot  } 

l 
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}  _ _ _ _  __  __ 

I 

!  FUNCTION  CSC 

j  This  Function  finds  the  Cosscsnt  of  an  angle  in  radians. 

j  Algorithm  s  If  tha  absolut*  valua  of  XVal  is  sero,  sat  esc  to  infinity 
1  otharwisa,  find  tha  answer  using  tha  sina 

!  Author  :  Capt  Dava  Vallado  USAFA/DFA8  719-472-4109  20  Sap  1990 

I  Inputs  : 

I  XVal  -  Angla  to  taka  Cosacant  of  rad 

I  Outputs  : 

I  Csc  -  Rasult 

I 

I  Locals  t 

I  Tamp  -  Temporary  Real  variabla 

I  Constants  i 

!  Inifinity  -  Valua  to  rapraaant  infinity 

I  Small  -  Tolaranca  valua 

I 

- } 

FUNCTION  Csc  (  XVal  s  Extended  )  t  extended) 

CONST 

Infinity  i  Extended  *  999999.9) 

Small  t  Extended  3  0.000001) 

VAR 

Temp  t  EXTENDED) 

BEGIN 

Tempi3  Sin(  XVal  )) 

IP  ABS(  Temp  )  <  Small  THEN 
Csc  i=  Infinity 
ELSE 

Csc  i=  1.0  /  Temp) 

END)  {  Function  Csc  } 


{  - 

I 

I  FUNCTION  SBC 

I 

1  This  Function  finds  tha  secant  of  an  angle  in  radians. 

I  Algorithm  i  If  tha  absolute  valua  of  XVal  is  aero,  sat  sac  to  infinity 

I  otherwise,  find  tha  ansvar  using  tha  Cosine 

I  Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 

I  Inputs  i 

I  XVal  -  Angla  to  taka  secant  of  rad 

I  Outputs  i 

I  Sec  -  Result 

I 

I  Locals  i 

I  Temp  -  Temporary  Real  variabla 

I  Constants  i 

I  Inifinity  -  Valua  to  represent  infinity 

I  Small  -  Tolaranca  valua 

I 

- } 

FUNCTION  Sec  (  XVal  i  Extended  )  i  Extended) 

CONST 

Infinity  i  Extended  *  999999.9) 

Small  i  Extended  3  0.000001) 

VAR 

Temp  t  EXTENDED) 

BEGIN 

Temp  i=  Cos(  XVal  ); 

I?  ABS(  Temp  )  <  Small  THEN 
Sec  >=  Infinity 
ELSE 

Sec  i=  1.0  /  Tempi 
END)  {  Function  Sec  } 

{ 
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FUNCTION  ATAN2 


} 

{ 

! 

I 


Thi*  Function  performs  the  arc  tangent  2  function  which  resolves 
quadrants.  The  arguments  passed  are  the  aine  and  cosine  values. 

Algorithm  >  Determine  the  quadrant  using  1?  statments 

If  the  answer  Is  not  a  sepcial  case,  0,  ISO,  etc 
find  the  arctangent 

otherwise,  find  the  special  case  values 


Author  i  Capt  Dave  Vallado  USATA/DFAS  719-472-4109  12  Aug  1988 


Inputs 

SinValue 

CosValue 


-  Sine  of  desired  angle 

-  Cosine  of  desired  value 


rad 

rad 


Outputs 

Atan2 


i 

-  Arctangent  with  resolved  quadrants 


Locals 

TanArg 

Quadrant 

Slnlnteger 


* 

-  Temporary  extended  Value 

-  Quadrant  of  the  answer 

-  Sign  of  the  value 


Constants 

Pi 

TwoPl 


3.14159265359 

6.28318530717959 


Coupling  i 

None. 


0.0  to  2P1  rad 


12  3  4 
+1  or  -1 


) 


FUNCTION  ATan2  (  SinValue, CosValue  ;  extended  )  i  extended; 

CONST 

Pi  i  Extended  -  3.14159265359; 

TwoPl «  extended  =  6.28318530717959; 

VAR 

TanArg  i  extended; 

Quadrant,  Slnlnteger  i  Integer; 

BEGIN 

Quadrant ;«  5; 

ir  (SinValue  >  0.0  )  and  (8inValue  <  1.0  )  and 

(CosValue  >  0.0  )  and  (CosValue  <  1.0  j  THIN 

quadrant;®  1; 

IF  (SinValue  >  0.0  ;  and  (SinValue  <  1.0  )  and 

(CosValue  <  0.0  )  and  (CosValue  >-1.0  )  THIN 

quadrant;®  2; 

IF  (SinValue  >  -1.0  )  and  (SinValue  <  0.0  )  and 

(CosValue  <  0.0  )  and  (CosValue  >-1.0  )  THEN 

quadrant;®  3; 

IF  (SinValue  >  -1.0  )  and  (SinValue  <  0,0  )  and 

(CosValue  >  0.0  j  and  (CosValue  <1.0  j  them 

quadrant;®  4; 

IF  Quadrant  <>  5  THEN 
BEGIN 

tanarg;®  arctan(SlnValue/CosValue) ; 

IF  (Quadrant  <  4)  and  (Quadrant  <>  1)  THEN 
tanarg;®  tanarg  +  Pi 

ELSE 

IF  Quadrant  =  4  THEN 

tanarg ;=  tanarg  +  TwoPl; 

END 

ELSE 

BEGIN  (  Special  Cases  } 

Slnlnteger;®  Round(SlnValue); 

CASE  Slnlnteger  OF 

-1  ;  TanArg:®  3.0*Pi/2.0; 

0  ;  IF  ROUND (CosValue)  >  0.0  THIN 
TanArg;®  0.0 
ELSE 

TanArg;®  Pi; 

1  ;  TanArg;®  Pl/2.0; 

END;  {  Case  } 

END; 

ATan2;=  tanarg; 

END;  {  Function  Atan2  } 

{ 


B-7 


{ 


I  JUNCTION  ARCSIN 

I 

1  This  function  evaluates  Arc  Sin*  using  tha  standard  Arc  Tangant  function. 

I  Author  <  capt  Dava  VaXlado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I  Algorithm  t  if  tha  absoluta  valua  of  tha  arguaant  (XVal)  ia  laaa  than  1.0 

1  find  tha  answer  using  tha  ARCTAN  function 

I  alsa 

i  If  tha  absoluta  valua  of  tha  argumant  (XVal)  is  vary  closa  to  1.0 

I  If  XVal  la  posltiva 

I  tha  ansvar  =  90  dsgraas 

I  alaa 

!  tha  ansvar  =  -90  dagraas 

I  alsa 

I  vrlta  an  arror  maasaga  to  tha  scraan 

I  Inputs  t 

I  XVal  -  Angla  valua  -1.0  to  1.0  rad 

I  Outputs  i 

I  ArcSln  -  Rasult  -Pi/2  to  Pl/2  rad 

I  Locals  t 

I  Tamp  -  Temporary  Extended  Valua 

I  Constants  > 

I  Pi  -  Pi 

!  Small  -  Tolaranca 

I 

I  Coupling  i 

I  None. 

I 

- ) 

FUNCTION  ArcSln  (  XVal  i  Extended  )  i  Extended) 

CONST 

Small  i  Extended  =  0.0000011 
Pi  :  Extended  =  3.14159285359) 

VAR 

Tamp  t  Extended) 

BEGIN 

IF  ABS(  XVal  )  <  1.0  THEN 

Temp i =  ArcTan{  XVal  /  SQRT(1.0  -  XVai*XVal)  ) 

ELSE 

IF  ABS(XVal)-1.0  <  Small  THEN 
IF  XVal  >  0.0  THIN 

Tempi*  Pi  /  2.0  {  XVal  3  1.0  } 

ELSE 

Tempi*  -Pi  /  2.0  {  XVal  3  -1.0  ) 

ELSE 

Wrlteln(  'Error  in  ArcSln  argument  3  ',XVal  )) 

ArcSim*  Temp) 

END)  {  Function  ArcSln  ) 
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FUNCTION  ARCCOS 


This  function  evaluates  Arc  Cosine  using  tha  ArcSin  function. 

Algorithm  s  If  tha  absoluta  valua  of  the  argument  (XVal)  is  lass  than  1.0 
find  tha  answer  using  tha  ARCTAK  function 
else 

If  tha  absoluta  valua  of  the  argument  (XVal)  is  vary  close  to  1.0 
If  XVal  is  positive 

tha  answer  =  90  degrees 

else 

tha  answer  =  -90  degrees 

else 

write  an  error  mesuga  to  the  screen 


Author 

Inputs 

XVal 

Outputs 

ArcCos 

Locals 

Temp 

Constants 

Pi 

Small 

Coupling 

ARCSIN 


i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  12  Aug  1988 


Angle  Value 


Result 


-1.0  to  1.0  rad 

0.0  to  Pi  rad 


-  Temporary  Extended  Value 

i 

-  Pi 

-  Tolerance 


i 


Sine  of  an  angle  in  radians 


FUNCTION  ArcCos  (  XVal  i  Extended  )  t  Extended; 

CONST 

Small  i  Extended  =  0.000001; 

Pi  i  Extended  =  3.14159265359; 

VAR 

Temp  i  Extended; 

BEGIN 

IF  ABS(XVal)  <  1.0  THEN 
BEGIN 

Tempt*  ArcSln(  SQRT(1.0  -  XVal*XVal)  ); 

IF  XVal  <0.0  THEN 
Tempi*  Pi  -  Temp; 

END 

ELSE 

IF  ABS( XVal) -1.0  <  Small  THEN 
IF  XVal  >  0.0  THEN 

Tempi*  0.0  {  XVal  *  1.0  } 

ELSE 

Tempi*  Pi  {  XVal  =  -1.0  } 

ELSE 

Wrlteln(  'Error  in  ArcCos  argument  *  '/XVal  ); 

ArcCos i*  Temp; 

END;  {  Function  ArcCos  ) 

( 
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} 

{ 


FUNCTION  COSH 


This  function  evaluates  the  hyperbolic  cosine  function. 
Algorithm  t  Calculate  tha  answer 

Author  :  Capt  Dave  Vail ado  USAFA/DFA3  719-472-4109 


Inputs 

XVal 

Outputs 

Cosh 


-  Angle  value 


-  Result 


Locals  i 

None. 

Coupling  i 

None. 


20  Sep  1990 
any  real 
1.0  to  Infinity 


} 


FUNCTION  Cosh  '(  XVal  :  Extended  )  i  Extended; 

BEGIN 

Cosh»=  0,5*(  EXP(XVal)  +  exp (-XVal)  )| 

END;  {  Function  Cosh  } 


FUNCTION  AACCOSH 

Tnls  function  evaluates  the  inverse  hyperbolic  cosine  function. 


Algorithm 

Author 

Inputs 

XVal 

OutPuts 

ArcCosh 

Locals 

Temp 

Constants 

Undefined 

Coupling 

None. 


:  If  XVal  squared  -  1  Is  less  than  zero,  set  to  undefined 
t  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  20  Sep  1990 


-  Angle  Value 
; 

-  Result 


-  Temporary  Extended  Value 


1.0  to  Infinity 
any  real 


Flag  value  for  an  undefined  quantity 


FUNCTION  ARCCoah  (  XVal  t  Extended  )  ;  Extended; 

CONST 

Undefined  >  Extended  =  999999.1; 

VAR 

Temp  ;  Extended; 

BEGIN 

IF  XVal*XVal  -  1.0  <  0.0  THEN 
ESGIN 

Temps=  Undefined; 

WriteLn(  'Error  In  ArcCosh  Function  1  ); 

END 

ELSE 

Temps =  LN(  XVal  +  SQRT(  XVal*XVal  -  1.0  )  ); 


ArcCoshs=  Temp; 

END;  {  Function  ArcCosh  } 
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} 

I 

I  FUNCTION  SINK 

I 

I  This  function  evaluates  the  hyperbolic  sine  function, 
i  Algorithm  >  Calculate  the  answer 

I  Author  s  Capt  Dave  Vallado  U8AFA/DPAS  719-472-4109  20  Sep  1990 

I  Inputs  s 

I  XVal  -  Angle  Value  any  real 

I 

I  OutPuts  : 

I  Slnh  -  Result  any  real 

I  Locals  : 

I  None . 

I 

I  Coupling  t 

I  None . 

I 

- } 

FUNCTION  Sinh  (  XVal  t  Extended  )  t  Extended; 

BEGIN 

Slnh»=  0.5*(  EXP(XVal)  -  EXP(-XVal)  ); 
end;  {  Function  Sinh  } 


{ 


!  FUNCTION  ARC SINH 

I 

I  This  function  evaluates  the  Inverse  hyperbolic  sine  function. 

I  Algorithm  ;  Calculate  the  answer 

!  Author  i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  20  Sep  1990 

I  Inputs  ; 

I  XVal  -  Angle  Value  any  real 

!  Outputs  t 

i  ArcSlnh  -  Result  any  real 

I  Locals  t 

I  None. 

I 

I  Coupling  t 

I  None. 

I 

-  } 

FUNCTION  ARCSlnh  (  XVal  i  Extended  )  t  Extended; 

BEGIN 


ArcSlnhi=  LN(  XVal  +  SQRT(  XVal*XVal  +1.0  )  ); 
END;  {  Function  ArcSlnh  } 


{ 


}  _  _ 

I 

I  1  UNCTION  TANH 

I 

I  This  function  evaluates  the  hypexbolic  tangent  function. 

I  Algorithm  s  Calculate  the  answer 

I  Author  :  Capt  Dave  Vallado  UCAFA/DFAS  719-472-4109  20  Sep  1990 

I  Inputs  < 

I  xval  -  Angle  Value  any  real 

I  Outputs  t 

I  Tanh  -  Result  -1.0  to  1.0 

! 

1  Locals  i 

I  None . 

I 

I  Coupling  > 

I  None . 

I 

- } 

FUNCTION  Tanh  (  xval  >  Extended  )  t  Extended) 

BEGIN 

Tanh:=  (  EXP(XVal)  -  EXP(-XVal)  )  /  (  EXF(XVal)  +  EXP(-XVal)  )) 

END;  {  Function  Tanh  ) 


{  - 

I 

I  FUNCTION  ARCTANH 

I 

I  This  function  evaluates  the  Inverse  hyperbolic  tangent  function. 

I  Algorithm  >  Check  for  divide  by  sero  and  write  error 
I  Calculate  the  answer  if  possible 

I  Author  i  Capt  Dave  Vallado  U8APA/DPAS  719-472-4109  20  Sep  1990 

I  Inputs  t 

I  XVal  -  Angle  Value  -1.0  to  1.0 

I  OutPuts  i 

I  ArcTanh  -  Result  any  real 

I  Locals  ! 

I  Tamp  -  Temporary  Extended  Value 

I  Constants  i 

I  Small  -  Tolerance 

I  Undefined  -  Flag  value  for  an  undefined  quantity 

I  Coupl lng  i 

I  None. 

I 

- } 

FUNCTION  ARCTanh  (  XVal  «  Extended  )  i  Extended) 

Const 

Small  i  Extended  =  0.000001 
Undefined)  Extended  =  999999.1) 

VAR 

Temp  )  Extended; 

BEGIN 

IF  1.0  -  ABS(XVal)  <  Small  THEN 
BEGIN 

Terap:=  Undefined) 

WriteLn(  'Error  in  ArcTanh  Function  •  )) 

END 

ELSE 

Temp ; =  0.5  *  LN(  (1.0  +  XVal)  /  (1.0  -  XVal)  )) 

ArcTanh) =  Temp) 

END)  {  Function  ArcTanh  } 

{ 
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} 

{ 


FUNCTION  DOT 


This  Function  finds  ths  dot  product  of  ti  >  vsctors. 


Algorithm 

Author 

Inputs 

Vecl 

Vec2 


t  Calculate  ths  snswsr  dlrsctly 
t  Capt  Davs  Vallado  U8AFA/DFAS  719-472-4109 


-  Vsctor  number  1 

-  Vsctor  number  2 


12  Aug  1988 


Outputs  > 

Dot  -  Result 

Locals  : 

None. 

Coupling  s 

None. 

- } 


FUNCTION  DOT  {  Vscl,Vsc2  t  Vsctor  )  i  Extended; 

BEGIN 

D0Tt  =  Vecl[l)*Vec2[l]  +  Vecl[2]*Vec2[2]  Vecl[3]‘Vec2(3]) 

END)  {  Function  Dot  } 


PROCEDURE  CROSS 

This  procedure  crosses  two  vectors. 


Algorithm 


Author 

Inputs 

Vecl 

Vec2 

Outputs 

OutVec 

Locals 

None. 

Coupling 

HAG 


i  Calculate  each  vector  component 
Find  the  magnitude  of  the  answer 

i  Capt  Dave  Vallado  USAFA/dfas  719-472-4109  12  Aug  1988 


-  Vector  number  1 

-  Vector  number  2 

t 

-  Vector  result  of  A  x  B 


Magnitude  of  a  vector 


PROCEDURE  CROSS  (  Vecl,Vec2  i  Vector) 

VAR  OutVec  >  Vector  )) 

BEGIN 

OutVec ( 1 ] i =  Vecl ( 2 ] * Vec2 ( 3 ]-Vecl ( 3 1 *Vec2 [ 2 ) ) 

OutVec [ 2 ] i =  Vecl [ 3 ] * Vec2 [ 1 ]-Vecl [ 1 J  * Vec2 [ 3 ] ) 

0utVec(3] :=  Vecl[l)*Vec2[2]-Vecl[2]*Vec2[l]) 

MAG(  OutVec  )) 

END;  {  Procedure  Cross  } 

{ 
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} 

{ 


I 


I  PROCEDURE  MAG 

I 

I  This  procedure  finds  tha  magnitude  of  a  vacfcor.  Tha  tolaranca  is  sat  to 
I  0.000001.  thus  tha  1.0E-12  for  tha  squared  tast  of  underflows. 

I  Algorithm  t  Find  tha  squarad  sum  of  tha  tarms 
I  Check  to  be  sura  thara  is  no  SORT  of  0.0 

I  Author  i  Capt  Dava  Vallado  ’JSAFA/DFAS  719-472-4109  20  Sap  1990 

I  Inputs  : 

I  Vac  -  Vector 

I 

I  Outputs  t 

I  Vec  -  Answer  storad  in  fourth  component 

I  Locals  : 

I  Hone . 

I 

I  Coupling  : 

I  None. 

I 

- } 

PROCEDURE  MAG  (  VAR  Vac  i  Vactor  )> 

VAR  Tamp:  Extended) 

BEGIN 

Temp:=  Vec[ l]*Vac(l)  +  Vac[2]»Vec(2)  +  Vacl3)*Vact3)i 

IF  ABS(  Temp  )  >=  1.0K-12  THEN 
Vec(4) :=  SQRT(  Temp  ) 

ELSE 

Vac[4]:-  0.0; 

END)  {  Procedure  Mag  } 

{  - 

I 

I  PROCEDURE  NORM 

I 

I  This  Procedure  calculates  a  unit  vactor  given  tha  original  vactor.  If  a 
I  zero  vactor  is  input .  tha  vactor  is  sat  to  saro. 

I  Algorithm  :  Find  tha  magnitude  of  tha  input  vactor  If  not  dona 

!  Check  if  tha  magnituda  is  greater  than  saro 

I  Author  :  Capt  Dava  Vallado  USAFA/DFAS  719-472-4109  21  Aug  1986 

I  Inputs  : 

I  Vec  -  Vactor 

I 

I  Outputs  : 

I  OutVec  -  Unit  Vactor 

I 

I  Locals  : 

I  i  -  Index 

I 

I  Constants  : 

I  Small  -  Tolaranca  factor 

I 

I  Coupl tng  : 

I  MAG  Magnitude  of  a  vactor 

- - - } 

PROCEDURE  NORM  (  Vic  :  Vector) 

VAR  f  tVac  :  Vector  )) 

CONST 

Small  :  Extended  =  0.000001) 

VAR 

i  :  INTEGER) 

BEGIN 

MAG(  Vec  ); 

IF  Vec[4]  >  Small  THEN 
FOR  I:®  1  to  4  DO 

OutVec[i]i=  Vec[i)/Voc[4J 

ELSE 

FOR  1  to  4  DO 
OutVec(i):=  0.0) 

END)  {  Procedure  Norm  ) 
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} 

{ 


PROCEDURE  ROT1 


i 


j  This  procedure  performs  a  rotation  about  the  1st  axis. 

I  Algorithm  i  Store  3rd  component  for  later  use 

j  Calculate  Sine  and  Cosine  values  to  make  sore  efficient 

\  Find  the  new  vector 

I 

I  Author  ;  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I  Inputs  s 

I  Vec  -  Input  vector 

I  XVal  -  Angle  of  rotation  rad 

I  Outputs  ; 

I  OutVec  -  Vector  result 

I 

1  Locals  i 

I  c  -  Cosine  of  the  angle  XVal 

I  s  -  Sine  of  the  angle  XVal 

I  Temp  -  Temporary  Extended  value 

I  Coupling  i 

I  None. 

I 

- } 

PROCEDURE  ROT1  (  Vec  t  Vector; 

XVal  i  Extended; 

VAR  OutVec  i  Vector  ), 

VAR 

c,  a,  Temp  :  Extended; 

BEGIN 

Tempi?  Vec[3]; 
ct=  cos (  XVal  ); 
si?  sinj  XVal  ); 

OutVec[3];=  c*Vec[3]  -  s*Vac(2]; 

OutVec! 2]  ;=  c*Vec!2]  4-  e*Temp; 

OutVecil];?  Vec(lj; 

OutVec! 4] ; =  Vec! 4]; 

END;  {  Procedure  Rotl  } 

{ 
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} 

{ 


PROCEDURE  ROT 2 


This  procedure  perform*  *  rotation  about  tha  2nd  axis. 


Algorithm 


Author 


Inputs 

Vec 

XVal 


Outputs 

OutVec 


:  Store  3rd  component  for  later  use 
Calculate  Sine  and  Cosine  values  to  make  more  efficient 
Find  the  new  vector 

s  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 


-  Input  vector 

-  Angle  of  rotation  rad 


-  Vector  result 


Locals 

c 

s 

Temp 

Coupling 

Non*. 


-  Cosine  of  the  angle  XVal 

-  Sin*  of  the  angle  XVal 

-  Temporary  Extended  value 

t 


} 


PROCEDURE  ROT2  (  v*c  i  Vector ) 

XVal  s  Extended) 

VAR  OutVec  i  Vector  )> 

VAR 

c,  a,  Temp  i  Extended) 

BEGIN 

Temp:=  Vec[3]> 
ci=  cos(  XVal  )) 

S!=  sin(  XVal  )) 

OutVec( 3] s=  c*Vec( 3]  +  s*V*c[lJ) 

OutVec! 1) i=  c»V*c(l)  -  a*Temp) 

OutVect 2 )  i  =  Vec[ 2] ) 

OutVec! 4)  i=  V*c( 4]) 

END)  {  Procedure  Rot2  } 
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} 

( - 

I 

I  PROCEDURE  ROT  3 

I 

I  This  procedure  performs  a  rotation  about  tha  3rd  axis. 

I  Algorithm  ;  Stora  2nd  componant  for  latar  uaa 

I  Calculate  Sina  and  Coalna  values  to  make  more  efficient 

j  Find  the  new  vector 

I 

I  Author  t  Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  12  Aug  1988 

I 

I  Inputs  s 

I  Vac  -  Input  vector 

i  xval  -  Angle  of  rotation  rad 

I  Outputs  t 

I  OutVec  -  Vector  result 

I 

i  Locals  t 

I  c  -  Cosine  of  the  angle  XVal 

I  s  -  Sine  of  the  angia  XVal 

I  Temp  -  Temporary  Extended  value 

I  Coupling  i 

I  None. 

I 

procedure  ROT 3  {  Vec  »  Vector; 

XVal  i  Extended; 

VAR  OutVec  i  Vector  ); 

VAR 

c,  g,  Temp  :  Extended; 

BEGIN 

Temp:=  Vec(2); 
c;=  cos(  XVal  ); 
s :  =  sln(  XVal  ); 

OutVec(2]i=  c*Vec[2)  -  s*Vec(l]; 

OutVactlj is  c*Vecllj  ♦  s*Teep; 

OutVec[3]«=  Vac[3]; 

OutVec[4]i=  Vac[4j; 

END;  {  Procedure  Rot3  } 

{ 
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} 

{ - 

I 

I  PROCEDURE  ADDVEC 

I 

)  This  procedure  adds  two  vectors. 

I  Algorithm  :  Loop  to  find  each  coeponent 
I  Find  the  magnitude  of  the  vector 

I  Author  s  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I  Inputs  t 

I  Vecl  -  Vector  number  1 

I  Vec2  -  Vector  number  2 

I 

I  Outputs  1 

I  OutVec  -  Vector  result  of  A  +  B 

I 

I  Locals  t 

I  1  -  Index 

I 

I  Coupling  s 

I  HAG  Magnitude  of  a  vector 

- } 

PROCEDURE  ADDVEC  (  Vecl,Vec2  t  Vector; 

VAR  OutVec  i  Vector  ); 

VAR 

1  i  Integer; 

BEGIN 

FOR  i;=l  to  3  DO 

OutVec! 1 ] :=  Veel[l)  +  Vec2[l]; 

HAG(  OutVec  ); 

END;  {  Procedure  AddVec  } 


( - 

I 

I  PROCEDURE  ADD3VEC 

I 

'  This  procedure  adds  three  vectors. 

I  Algorithm  i  Loop  to  find  each  component 
I  Find  the  magnitude  of  the  vector 

I  Author  >  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I  Inputs  i 

Vecl  -  Vector  nuafeer  1 

Vec2  -  Vector  number  2 

Vec3  -  Vector  nuafeer  3 

Outputs  i 

OutVec  -  Vector  result  of  Vecl  +  Vec2  +  Vec3 

Locals  > 

1  -  Index 

Coupling  i 

HAG  Magnitude  of  a  vector 

PROCEDURE  ADD3VEC  (  VeclfVec2,Vec3  «  Vector; 

VAR  OutVec  ;  Vector  ); 

VAR 

i  t  Integer; 

BEGIN 

FOR  it=l  to  3  DO 

OutVec[i]«=  Vacl[l]  +  Vec2(l]  +  Vec3[l]; 

HAG(  OutVec  ); 

END;  {  Procedure  Add3Vec  } 
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} 

{ 


PROCEDURE  LNCOM1 

This  procedure  calculates  the  linear  combination  of  a  vector 
multiplied  by  a  constants. 


Algorithm 


Author 

Inputs 

A1 

Vec 

Outputs 

OutVec 

Locals 

1 

Coupling 

HAG 


t  Loop  to  find  each  combination 
Find  the  magnitude  of  the  vector 

:  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  12  Aug  1988 


-  constant  number 

-  Vector  number 


Vector  result  of  Al*Vecl  +  A2*Vec2 


-  Index 


Magnitude  of  a  vector 


PROCEDURE  LNC0M1  {  A  s  Extended) 

Vec  t  Vector) 

VAR  OutVec  i  Vector  )) 

VAR 

i  i  Integer) 

BEGIN 

FOR  lt=  1  to  3  DO 

OutVec[l)i=  A*Vec[l]) 

MAG{  OutVec  )) 

END)  {  Procedure  LnComl  } 


PROCEDURE  LNCOM2 

This  procedure  calculates  the  linear  combination  of  two  vectors 
multiplied  by  two  different  constants. 


Algorithm 


Author 

Inputs 

A1 

A2 

Vecl 

Vec2 

Outputs 

OutVec 

Locals 

1 

Coupling 

HAG 


t  Loop  to  find  each  combination 
Find  the  magnitude  of  the  vector 

I  Capt  Dave  Vallado  U8AFA/DFA8  719-472-4109  12  Aug  1988 

t 

-  constant  number  1 

-  constant  number  2 

-  Vector  number  1 

-  Vector  number  2 

i 

-  Vector  result  of  Al*Vecl  +  A2*Vec2 


-  Index 


Hagnitude  of  a  vector 


PROCEDURE  LNC0N2  (  A1.A2  t  Extended) 

VeclfVec2  i  vector) 

VAR  OutVec  t  Vector  )) 

VAR 

i  t  Integer) 

BEGIN 

FOR  li=  1  to  3  DO 

OutVec[l]>=  al*Vecl(l)  +  a2*Vec2(l]i 
MAG(  OutVec  )> 

END)  {  Procedure  LnCom2  } 


{ 
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} 


I  PROCEDURE  LNCOM3 

I 

I  This  procedure  calculates  ths  linsar  combination  of  thraa  vectors 
I  multiplied  by  three  different  constants. 

I  Algorithm  i  Loop  to  find  each  combination 
I  Find  the  magnitude  of  the  vector 

!  Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 

I  Inputs  t 

I  A1  -  constant  number  1 

1  A2  -  constant  number  2 

I  A3  -  constant  number  3 

I  Vecl  -  Vector  number  1 

I  Vec2  -  Vector  number  2 

I  Vec3  -  Vector  number  3 

I 

I  OutPuts  : 

I  OutVec  -  Vector  result  of  Al*Vecl  +  A2*Vec2  +  A3*Vec3 

1  > 

I  Locals  : 

I  i  -  Index 

I 

I  Coupling  > 

I  MAG  Magnitude  of  a  vector 

- } 

PROCEDURE  LNCOM3  (  A1,A2,A3  (  Extended) 

Vecl,Vec2,Vec3  t  Vector; 

VAR  OutVec  t  Vector  ); 

VAR 

1  t  Integer; 

BEGIN 

FOR  li=  1  to  3  DO 

OutVecllh*  al*Vecl[l]  +  a2*Vec2[i]  +  a3*Vec3[l]) 

MAG(  OutVec  ); 

END)  {  Procedure  LnCom3  ) 

{ 
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} 

{ - 

I 

I  PROCEDURE  ANGLE 

I  This  procedure  calculates  th«  angle  between  two  vector*.  The  output  is 
1  set  to  999999.1  to  indicate  an  undefined  value.  Be  SURE  to  check  for 
I  this  at  the  output  phase. 

I  Algorithm  t  Check  the  denominator  for  a  divide  by  sero 
I  Check  for  exactly  1.0  or  -1.0  to  avoid  ArcCoslne  problems 

I  Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  14  Sep  1990 

I  Inputs  t 

I  Vecl  -  Vector  number  1 

i  Vec2  -  Vector  number  2 

I 

i  Outputs  t 

i  Theta  -  Angle  between  the  two  vectors  -Pi  to  Pi 

I 

I  Locals  t 

I  Temp  -  Temporary  REAL  variable 

I  Constants  t 

j  Undefined  -  Undefined  flag  for  a  variable 
I  Small  -  Tolerance  factor 

I 

!  Coupling  t 

I  dot  Dot  Product  of  two  vectors 

f  ArcCos  Arc  Cosine  function 


PROCEDURE  ANCLE  (  Vecl,Vec2 

VAR  Theta 

CONST 

Small  >  Extended  *  0.000001; 

Undefined;  Extended  *  999999.1; 

VAR 

Temp  ;  Extended; 

BEGIN 

IF  Vecl(4]*Vec2(4]  >  SQR(Small)  THIN 
BEGIN 

Tempi*  DOT < Vecl, Vec2)  /  (Veclt4J»Vec2(4)); 
IF  AB8(  Temp  )  >  1.0  THEN 
Tempt*  SGN(Temp)  *  1.0; 

Theta ARCCOS (  Temp  ); 

END 

ELSE 

Thetai*  Undefined; 

END;  {  Procedure  Angle  ) 

{ 


t  Vector; 

;  Extended  ); 
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} 

I  "  '  ■—  ~  - 

I  PROCEDURE  QUADRATIC 

I  This  procedure  solves  for  the  two  roots  of  a  quadratic  equation.  There  are 
I  no  restrictions  on  the  coefficients,  and  Imaginary  results  are  passed 

I  out  as  separate  values.  The  general  form  Is  y  =  ax2  +  bx  +  c. 

I  Algorithm  :  Initialise  all  values 
i  Find  discriminate 

I  Use  discriminate  value  to  separate  the  root  calculations 

I  Author  t  Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  18  Jun  1990 

I  Inputs  : 

I  a  -  Coefficient  of  x  squared  term 

!  b  -  Coefficient  of  x  term 

i  c  -  Constant 

I 

I  Outputs  I 

I  Rlr  -  Real  portion  of  Root  1 

I  Rll  -  Imaginary  portion  of  Root  1 

I  R2r  -  Real  portion  of  Root  2 

I  R21  -  Imaginary  portion  of  Root  2 

I  Locals  t 

I  Dlscrlm  -  Discriminate  b2  -  4ac 

I 

I  Constants  i 

I  None. 

I 

I  Coupling  i 

I  Non*. 

i 

1  References  i 

I  Escobal  pg.  433-434 

- } 

PROCEDURE  Quadratic  (  a,b,c  t  Extended) 

VAR  Rlr,Rll,R2r,R21  t  Extended  ); 

VAR 

Dlscrlm  i  Extended) 

BEGIN 

{  — - — -  Initialise  - - - } 

Rlri=  0.0) 

Rll  t  =  0.0) 

R2ri  =  0.0) 

R21 Is  0.0) 

Discrlmt=  b*b  -  4.0*a*C) 

{ -  Real  roots  - } 

IF  Dlscrlm  >  0.0  THEN 
BEGIN 

Rlrt=  {  -b  +  SQRT(Dlscrim)  )  /  (  2.0*a  )) 

R2ri=  (  -b  -  SQRT(Discrim)  )  /  (  2.C*a  )) 

END 

ELSE 

{ - Complex  roots  — - - } 

BEGIN 

Rlr»=  -b  /  (  2.0*a  )) 

R2ri=  Rlr> 

Rlli=  SQRT(-Discrlm)  /  (  2.0*a  )) 

R21«=  -SQRT(-Discrlm)  /  (  2.0*a  )) 

END) 

END)  (  Procedure  Quadratic  } 
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} 

{ - 

I  PROCEDURE  CUBIC 

I  This  procedure  solves  for  the  three  roots  of  a  cubic  equation.  There  are 
I  no  restrictions  on  the  coefflcients>  and  imaginary  results  are  passed 

I  out  as  separate  values.  The  general  form  is  y  =  ax3  +  bx2  +  cx  +  d.  Mote 

!  that  Rli  will  ALWAYS  be  ZERO  since  there  is  ALWAYS  at  least  one  RIAL  root. 

I  Algorithm  >  Initialize  variables 

I  Find  correct  coeffclants  for  the  form  of  solution 

I  IF  Delta  is  positive 

I  IF  Delta  is  zero 


Author 

Inputs 

a 

b 

c 

d 


else 

find  answers  where  Delta  is  negative 
:  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  18  Jun  1990 

i 

-  Coefficient  of  x  cubed  term 

-  Coefficient  of  x  squared  term 

-  Coefficient  of  x  term 

-  Constant 


Outputs 

Rlr 

Rli 

R2r 

R21 

R3r 

R3i 


-  Real  portion  of  Root  1 

-  Imaginary  portion  of  Root  1 

-  Real  portion  of  Root  2 

-  Imaginary  portion  of  Root  2 

-  Real  portion  of  Root  3 

-  Imaginary  portion  of  Root  3 


Locals 
Tempi 
Temp2 
Rootl 
Root  2 
Root  3 
P 
0 
R 

Delta 

10 

Phi 

CosPhl 

SlnPhl 


-  Temporary  value 

-  Temporary  value 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  Coefficient  of  x  squared  term  where  x  cubed  term  is  1.0 

-  Coefficient  of  x  term  where  x  cubed  term  is  1.0 

-  Coefficient  of  constant  term  where  x  cubed  term  is  1.0 

-  Discriminator  for  use  with  Cardans  formula 

-  Angle  holder  for  trigonometric  solution 

-  Angle  used  in  trigonometric  solution 

-  Cosine  of  Phi 

-  Sine  of  Phi 


Constants 

Rad 

Small 

OneThlrd 

Coupling 

ATAN2 

References 

Bscobsl 


-  Radians  per  degree 

-  Tolerance  factor 

-  1. 0/3.0 


Arctangent  Including  check  for  180-360  deg 


pg.  430-433 


} 
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} 

PROCEDURE  Cubic  (  a,b,c,d  t  Extended; 

VAR  Rlr,Rli,R2r,R21,R3r,R31t  Extended  ); 

CONST 

Rad  :  Extended  *  57.29577951308230; 

OneThlrd  t  Extended  *  1. 0/3.0; 

Snail  t  Extended  *  0.000001; 

VAR 

tempi,  temp2,  Rootl,  Root 2,  Root3,  P,  Q,  R,  Delta, 

EO,  CoaPbi,  SinPhl,  Phi  t  Extended; 

BEGIN 

{ -  Initialise  - } 

Rlr  :=  0.0; 

Rll  !=  0.0; 

R2r  «=  0.0; 

R2i  t  =  0.0; 

R3r  :  =  0.0; 

R31  :  =  0.0; 

Rootl 1=  0.0; 

Root2;=  0.0; 

Root3:=  0.0; 

{ - Force  coefficient!  into  ltd  form - } 

P:  =  B/A; 

Qi=  C/A; 

R«=  D/A; 

a:=  On*Thlrd*(  3.0*Q  -  P*P  ); 

bt=  (1.0/27.0)*(  2.0*P*P*P  -  9.0*P*Q  +  27.0*R  ); 

Delta t=  (a*a*a/27.0)  +  (b*b/4.0); 

{ - Uie  Cardan*  formula - } 

IF  Delta  >  Small  THEN 
BEGIN 

T*:jpl:=  (-b*0.5)+9QRT(Delta); 

Temp 2 ; =  (-b*0.5)-SQRT(Delta); 

IF  ABS(Templ)  >  Small  THEN 

Tempi ; *  SON ( Tempi )*P0WER(  SCN{Tenpl)*Templ, OneThlrd  ); 

IF  ABS(Temp2)  >  Small  THEN 

Temp2;=  8GN(Temp2)*POWER(  SCN(Temp2)*Temp2, OneThlrd  ); 

Rootl i=  Tempi  +  Tenp2; 

Root2:=  -0.5* (Tempi  +  Temp2); 

Root3i=  -0.5*(Templ  +  Temp2); 

R2li»  -0.5*SQRT(  3.0  )*(Templ  -  Teep2); 

R31i=  -R21; 

END 

ELSE 

{  -  Evaluate  *ero  point  -  } 

BEGIN 

IF  ABS(  Delta  )  <  Small  THEN 
BEGIN 

IF  ABS(b)  >  Small  THEN 
BEGIN 

Rootl i =  -SGN(b)*2.0*POWER(  SGN(b)*b/2.0, OneThlrd  ); 
Root2:=  SGN(b)*POHER(  8GN(b)*b/2.0, OneThlrd  ); 

Root3i=  Root 2; 

END; 

{  elie  let  them  be  0.0  alnce  b  is  0.0  } 

END 

ELSE 

{  -  Use  trigonometric  Identities  -  } 

BEGIN 

E0  :  =  2.0*SQRT(-a*On*Thlrd); 

CosPhl:=  (-b/(2.0*SQRT(-a*a*a/27.0) )  ); 

SinPhl «=  SQRT(  1 . 0-CosPh 1 *CosPh 1  ); 

Phi  «*  ATAN2(  SinPhl, CosPhl  ); 

Rootl i-  E0*Cos(  Phl*OneThlrd  ); 

Root 21=  E0*Cos(  Phl‘On*Thlrd  +  120.0/Rad  ); 

Root3i=  E0*Cos(  Phi *OneThlrd  +  240.0/Rad  ); 

END; 

END; 

Rlr;  =  Rootl  -  P*OneThlrd; 

R2r:  =  Root 2  -  P*OneThlrd; 

R3ri  =  Root 3  -  P*OneThlrd; 

END;  {  Procedure  Cubic  } 
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PROCEDURE  QUARTIC 


This  procedure  solves  for  the  four  roots  of  a  quart ic  equation.  There  are 
no  restrictions  on  the  coefficients.  and  Imaginary  results  are  passed 
out  as  separate  values.  The  general  form  is  y  =  ax4  +  bx3  +  cx2  +  dx  +  e. 


Algorithm  t 

Author  t  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  18  Jun  1990 


Inputs 

a 

b 

c 

d 

e 


-  Coeficlent  of  x  fourth  term 

-  Coefficient  of  x  cubed  term 

-  Coefficient  of  x  squared  term 

-  Coefficient  of  x  term 

-  Constant 


Outputs 

Rlr 

Rll 

R2r 

R21 

R3r 

R3i 

R4r 

R41 


-  Real  portion  of  Root  1 

-  Imaginary  portion  of  Root  1 

-  Real  portion  of  Root  2 

-  Imaginary  portion  of  Root  2 

-  Real  portion  of  Root  3 

-  Imaginary  portion  of  Root  3 

-  Real  portion  of  Root  4 

-  Imaginary  portion  of  Root  4 


Locals 
Tempi 
Temp2 
Rootl 
Root  2 
Root3 
s 
h 

hSqr 

hCube 

P 

0 

R 

Delta 

E0 

Phi 

CoiPhi 

SlnPhi 

RPrime 

Temp 

Eta 

Beta 


> 

-  Temporary  value 

-  Temporary  value 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  alternate  variable 

-  Temporary  value 

-  h  squared 

-  h  Cubed 

-  Term  in  auxiliary  equation 

-  Term  in  auxiliary  equation 

-  Term  in  auxiliary  equation 

-  Discriminator  for  use  with  Cardans  formula 

-  Angle  holder  for  trigonometric  solution 

-  Angle  used  in  trigonometric  solution 

-  Cosine  of  Phi 

-  Sine  of  Phi 

-  Values  of  roots  before  final  work 

-  Temporary  variable  in  finding  MAX  RPrlM 

-  Constant  coefficient  in  quadratic  solutions 

-  Constant  coefficient  in  quadratic  solutions 


Constants  t 

Rad  -  Radians  per  degree 

Small  -  Tolerance  factor 

OneThlrd  -  1. 0/3.0 

Coupling  i 

AT AN 2  Arctangent  including  check  for  180-360  deg 

References  i 

Escobal  pg.  430-433 


) 
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PROCEDURE  Quartic  (  a,b,c,d,e  :  Extended; 

VAR  Rlr,Rll,R2r,R21,R3r,R31, 

R4r,R4i  t  Extended  ); 

CONST 

Rad  :  Extended  =  57.29577951308230; 

OneThird  s  Extended  =  1. 0/3.0; 

Small  s  Extended  =  0.000001; 

VAR 

Tempi,  Temp2,  Rootl,  Root 2,  Root3,  a,  h,  P,  Q,  R,  Delta,  EO, 

CosPhi,  SinPhi,  Phi,  RPrlae,  hSqr,  HCube,  Eta,  Beta,  temp  s  Extended; 
BEGIN 

{ -  Initialise  - } 

Rlr  :=  0.0; 

Rll  ;  =  0.0; 

R2r  :=  0.0; 

R21  :=  0.0; 

R3r  ;=  0.0; 

R31  :=  0.0; 

R4r  i=  0.0; 

R41  :  =  0.0; 

Rootl :=  0.0; 

Root2i=  0.0; 

Root3:=  0.0; 

{ - Force  coefficient  a  Into  atd  for* - } 

b;=  B/A; 
ci=  C/A; 


d:  =  D/A; 
e;  =  E/A; 


Hi=  -b/4; 

HSqr : =  SQR(  H  ); 
HCube i =  HSqr  *  H; 


P;=  6.0*HSqr  +  3.0‘b‘h  +  c; 
Q:  =  4.0*HCube  +  3.0»b*HSqr  +  2.0*c*h  +  d; 
R:=  h*HCube  +  b*HCube  +  c*HBqr  +  d»h  +  e; 


ai=  (1.0/  3 . 0 ) * {  -P*P-12.0*R  ); 

bs=  (1.0/27.0)*(  -2.0»P*P*P+72.0*P*R-27.0*Q*Q  ); 

»«=  -(2.0/  3.0)*P; 


Deltai=  (a*a*a/27.0)  +  (b*b/4.0); 


IF  ABS(Q)  >  Small  THEN 
BEGIN 

( - Uae  Cardana  formula  - - } 

i  IF  Delta  >  Small  THEM 
BEGIN 

Tempi t=  (-b*0.5)+SQRT(Delta); 

Temp2t=  (-b*0.5)-8QRT(Delta) ; 

IF  ABS(Tenpl)  >  Small  THEN 

Tempi;*  SON ( Tempi ) ‘POWER (  SGN(Templ)‘Templ, OneThird  ); 
IF  ABS(Temp2)  >  Small  THEN 

Temp2i*  SGN(Temp2)*POWER(  SGN(Temp2)*Temp2, OneThird  ); 
Rootl ; =  Tempi  +  Temp2; 

Root2i=  -0.5‘(Templ  +  Temp2); 

Root3;=  0.5‘(Templ  +  Temp2); 

R2 1 » =  -0.5‘SQRT(  3.0  )*(Templ  -  Temp2); 

R31i*  -R21; 

END 

ELSE 

{  - Evaluate  zero  point - } 

BEGIN 

IF  ABS(  Delta  )  <  Small  THEN 
BEGIN 

IF  ABS(b)  >  Small  THEN 
BEGIN 

Rootl ;=  -SGN(b)*2.0*POWER(  SGN(b)‘b/2.0, OneThird  ); 
Root2;=  SGN(b) ‘POWER (  SGN(b)*b/2.0, OneThird  )> 

Root 3!=  Root 2; 

END; 

{  else  let  them  be  0.0  since  b  la  0.0  } 

END 

ELSE 

{  -  Use  trigonometric  Identities  -  } 

BEGIN 

E0  i=  2.0*SQRT(-a»OneThlrd); 

CosPhi ;=  (-b/(2.0*SQRT(-a‘a‘a/27.0) )  ); 

SlnPhl ;=  SQRT(  1.0-CosPhl ‘CosPhi  ); 

Phi  t  =  AT AN 2 (  SlnPhl, CoaPhl  ); 

Rootl:*  B0*Cos(  Phl*OneThlrd  )i 

Root2;=  E0*Cos(  Phl‘OneThlrd  +  120.0/Rad  ): 

Root!:*  B0*Cos(  Phl*OneThlrd  +  240.0/Rad  ); 

END; 

END; 

{ 
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} 


{ - Find  largest  value  of  root - 1 - } 

RPrlmei=  Rootl+s; 

IF  (RPrlme  <  Root2+»)  and  (ABS(R21}<0.0001)  THIN 
RPrlme :=  Root2+s; 

IF  (RPrlme  <  Root3+s)  and  (ABS(R31)<0.0001)  THEN 
RPrimei=  Root3+s; 

{  -  Evaluate  coefficients  of  two  resulting  Quadratics  -  } 

IF  RPrime  >  Small  THEN 
BEGIN 

Eta  1=  0.5*(  P  +  RPrime  -  Q/SQRT( RPrlme)  ); 

Beta i =  0.5*(  P  +  RPrlme  +  Q/SQRT( RPrime)  ); 

END 

ELSE 

BEGIN 

Eta  :=  0.5*P; 

Betat=  0.5*P; 

END; 

Quadratlc(  1.0,  SQRT(RPrlme),Eta,  Rlr,Rli,R2r,R2i  ); 

Quadratic!  1.0,-SQRT(RPrlme),Beta,  R3r,R31,R4r,R41  ); 

END  {  If  Q  >  Small  } 

ELSE 

BEGIN 

{  -  Case  where  solution  reduces  to  a  quadratic  -  ) 

Quadratic!  1.0, P,R,  Rlr,Rll,R2r,R2i  ); 

Rlr«=  8QRT(  Rlr  );  i 

Rllt-  8QRT(  Rll  ); 

R2r;  =  SQRT(  R2r  ); 

R21 »=  SQRT(  R21  ); 

R3r»=  -Rlr; 

R31;  =  -Rli; 

R4r;  =  -R2r; 

R4i«*  -R21; 

END; 

Rlri=  Rlr  +  h; 

R2rt=  R2r  +  h; 

R3rt=  R3r  +  h; 

R4ri=  R4r  +  h; 

END;  {  Procedure  Quartlc  } 
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} 

{ - 

I 

I  PROCEDURE  INITMATRIX 

I 

I  This  procedure  initialise*  the  matricie*  in  pascal.  Notice  the  use  of  a 
I  record  structure.  This  allows  for  arrays  to  be  as  large  as  needed, 

I  provided  memory  exists.  Also  note  each  time  this  is  called,  NEW  is 

I  invoked.  Thus,  you  can  have  Heap  and  SMeory  problems  if  you  don't  use 

I  DelMatrix  to  clear  the  pointer  valuell 

|  i 

!  Algorithm  :  Loop  through  the  Rows 
I  Loop  through  the  cols 

I  Assign  a  NEB  pointer  and  all  record  fields 

I  Build  the  doubly  linked  list  of  pointers 

I  Author  :  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  24  Jan  1990 

I  Inputs  t 

I  Rows  -  Number  of  rows  for  the  matrix 

I  Cols  -  Number  of  columns  for  the  matrix 

I 

I  Outputs  i 

I  A  -  Matrix  to  be  initialized 

I 

I  Locals  t 

I  i  -  Index 

I  j  -  index 

I  NextData  -  PTR  to  next  data  value 

I 

I  Constants  : 

I  None. 

I 

I  Coupling  : 

I  None . 

I 

- } 

PROCEDURE  inltMatrlx  (  Rows, Cols  i  Integer; 

VAR  A  s  Matrix  ); 

VAR 

i,j  i  Integer; 

NextData  t  MatrlxDataPtr; 

BEGIN 

NEW(  A  ); 

A*.NumRowst=  Rows; 

A‘.NunCols;=  Cols; 

A*.DPtr  t=  NIL; 

A*. Head  NIL; 

A”. Tail  t=  NIL; 

FOR  ii=l  to  ROWS  DO 
BEGIN 

FOR  ji  =  1  to  Cols  DO 
BEGIN 

New(  NextData  ); 

With  NextData*  Do 
BEGIN 

Index  «*  ( 1—1 ) *A“ .NuatCols  +  j; 

Number;-  0.0; 

Next  ;*  NIL; 

Last  t*  NIL; 

END; 

IF  A*.DPtr  =  NIL  THEN 
BEGIN 

NextData*. Last;=  NIL; 

A*. Head  ;  =  NextData; 

END 

ELSE 

BEGIN 

NextData*. La*t:=  A*. Tall; 

A*. Tall*. Next  ;=  NextData; 

END; 

A*. Tail  i=  NextData; 

A*.Tall*.Nexc;s  NIL; 

A* .DPtr  i=  NextData; 

END; 

END; 

END;  {  Procedure  TnltHatrlx  } 
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} 

{ 


PROCEDURE  DELMATRIX 


This  procedure  deletes  a  matrix  in  pascal.  Hot lea  tha  uaa  of  a 

racord  atructura.  it' a  Important  to  claar  tha  valuaa  whan  no  longar 
needed,  or  whan  thay  will  ba  craatad  again. 

I 

Algorithm  t  Start  at  tha  haad  of  tha  pointar  liat 
Loop  whlla  not  pointing  to  NIL 
Diapoaa  of  aach  pointar 
Dispoaa  of  tha  laat  pointar 

Author  i  Capt  Dava  Vallado  USAFA/DFAS  719-472-4109  20  Oct  1989 


Inputs 

A 


I 

-  Matrix  to  ba  dalatad 


OutPuta 

A 


: 

-  Formar  Matrix 


Locals 

1 

j 

Tamp 

NaxtTamp 


Index 

indax 

ptr  to  data  valua 
PTR  to  naxt  data  valua 


Constants  ; 
Nona. 


Coupling  i 
Nona. 


PROCEDURE  DelMatrix  (  VAR  A  t  Matrix  ); 

VAR 

l,j  :  Integer; 

Tamp, NaxtTamp  :  MatrlxDataPtr; 

BEGIN 

Tamp  i=  A" .Head; 

WHILE  Tamp*. Naxt  <>  NIL  DO 
BEGIN 

NextTempt=  Tamp*. Naxt; 

DISPOSE(  Tamp  ); 

Tempi'  NaxtTamp; 

END; 

DISPOSE!  Temp  ); 

DISPOSE!  A  ); 

END;  {  Procedure  DelMatrix  } 
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} 

{ - 

I 

I  FUNCTION  GBTVAL 


This  function  gats  a  valua  from  tha  record  structura.  The  function  is 
necessary  to  decode  tha  data.  It's  set  up  to  resemble  tha  standard 
array  format,  however,  t's  ara  replaced  by  ('s. 


Algorithm 


Author 

Inputs 

A 

Rows 

Cols 

Outputs 

GetXVal 

Locals 

i 

j 

Constants 

None. 

Coupling 

None. 


:  Find  the  index  where  you  desire  to  get  data 
Loop  forward  or  backward  to  the  desired  index 
Assign  the  value 

:  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  24  Jan  1990 


-  Matrix 

-  Row  number  of  desired  element 

-  Col  number  of  desired  element 


Value  of  the  Row, Col  point 


-  Index 

-  index 


-  } 


FUNCTION  Getval  {  VAR  A  J  Matrix; 

Row, Col  i  Integer  )  i  Extended; 

VAR 

l,j  t  Integer; 

BEGIN 

jt=  ( Row-1  )*A\NumCols  +  Col; 

WHILE  <  j  >  A\DPtr*. Index  )  and  (  A*.DPtr“.Hext  <>  NIL  )  DO 
A\DPtrt=  A".DPtr*.Next; 

while  (  j  <  A'.DPtr". Index  )  and  {  A* .DPtr*.Last  <>  NIL  )  DO 
A*.DPtr;=  A*.DPtr\Last; 

GetVali=  A".DPtr“.Nuad>er; 

END;  {  Function  GetVal} 
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} 

{ 


PROCEDURE  ASSIGNVAL 


This  procedure  assigns  a  value  to  tha  racord  structura.  This  is 
necessary  to  dacoda  the  data.  It's  set  up  to  resemble  tha  standard 
array  format/  howevar,  ['s  are  replaced  by  ('s. 

Algorithm  t  Call  gatval  to  gat  the  pointer  at  tha  correct  index  location 
Assign  the  value  to  the  pointer  variable  record  field 

Author  t  Capt  Dave  Vallado  USAPA/DFAS  719-472-4109  24  Jan  1990 


Inputs  t 

A  -  Matrix 

Rows  -  Row  number  of  deal red  element 

Cols  -  Col  number  of  desired  element 

Number  -  Value  to  assign  at  the  desired  location 


Outputs 

A 


l 

-  Matrix 


Locals  t 

i  -  Index 

j  -  index 

Constants  : 

None. 

Coupling  i 

None. 

- - } 


PROCEDURE  AsslgnVal  (  VAR  A  i  Matrix) 

Row, Col  t  Integer) 

Number  i  Extended  )t 

VAR 

Temp  i  Extended) 

BEGIN 

Tempi*  GetVal(  A, Row, Col  )) 

A'.DPtr*. Number i=  Number) 

END)  {  Procedure  AsslgnVal  } 


I 
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! 

i 


PROCEDURE  HatHult 

This  procedure  multiplies  two  matrlcles  together. 

Algorithm  :  Initialize  the  pointers  for  the  result  matrix 
Loop  through  the  Rows 
Loop  through  the  Cols 
Loop  through  an  index 

Multiply  and  add  up  each  cell  value 


Author 

Inputs 


Coupling 

None. 

References 

None. 


i  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  12  Aug  1988 


Hatl 

- 

Matrix 

number 

1 

Hat2 

- 

Matrix 

number 

2 

Hatlr 

- 

Hatrlx 

number 

1 

rows 

Hatlc 

- 

Matrix 

number 

1 

columns 

Hat  2c 

- 

Matrix 

number 

2 

columns 

Outputs 

1 

Mat3 

- 

Matrix 

result 

of  Matl  * 

Locals 

t 

Row 

- 

Row  Index 

Col 

- 

Column 

Index 

ktr 

Index 

PROCEDURE  HatHult  {  Hatl,Hat2 

Hatlr, Matlc«Mat2c 
VAR  Mat3 

VAR 

Rov,Col,ktr  i  Integer; 

BEGIN 

lnltHatrlx{  Hatlr, Hat2c,Hat3  ), 

FOR  Rowi=l  to  matlr  DO 

FOR  Col i =  1  to  mat2c  DO 
BEGIN 

FOR  ktr;  =  1  to  matlc  DO 

AsslgnValf  Mat3,Row,Col,  CetVal(Mat3,Row,Col)+GetVal{Hatl,Rov,ktr)* 
GetVal(Mat2,ktr,Col)  )> 

END; 

END;  {  Procedure  HatHult  } 


<  Hatrlx; 
t  Integer  ; 
t  Hatrlx  ); 


} 

{ - 

I 

|  PROCEDURE  MatAdd 

I 

1  This  procedure  adds  two  matrlcies  together. 

j  Algorithm  i  Initialise  the  pointers  for  the  result  swtrix 

j  Loop  through  the  Rows 

j  Loop  through  the  Cols 

j  Add  up  each  cell  value 

I  Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  26  Jun  1989 

I 

I  Inputs  :  i 

j  Hatl  -  Matrix  number  1 

I  Mat2  -  Matrix  numbsr  2 

i  Matlr  -  Matrix  number  1  rows 

I  Matlc  -  Matrix  number  1  columns 

I 

|  Outputs  I 

I  Mat3  -  Matrix  result  of  Matl  +  Mat2  of  sise  matlr  x  matlc 

I 

I  Locals  > 

I  Row  -  Row  Index 

!  Col  -  Column  Index 

I 

I  Coupling  i 

I  None. 

I 

I  References  i 

I  None. 

I 

- } 

PROCEDURE  MatAdd  (  Matl,Mat2  «  Matrix; 

Matlr (Matlc  i  Integer  ; 

VAR  Mat3  s  Matrix  ); 

VAR 

Row, Col  i  Integer; 

BEGIN 

InitMatrlx(  Matlr, Matlc, Mat3  ); 

FOR  Row  1  to  Matlr  DO 
FOR  Col  i=l  to  Matlc  DO 

AsslgnVal(  Mat3,Row,Col,  CetVal(Matl,Row,Col)  +  GetVal(Hat2,Row,Col)  ); 
END;  {  Procedure  MatAdd  } 


i 

i 

f 

i 
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} 

{ 


PROCEDURE  MATTRANS 


i! 

\ 

t 

! 


This  procedure  finds  the  transpose  of  a  matrix. 


Algorithm 


Author 


Initialize  the  pointers  for  the  result  aatrix 
Loop  through  the  Rows 
Loop  through  the  Colt 

Transpose  each  cell  value 

Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 


Inputs  i 


Matl 

-  Matrix  number 

1 

Matlr 

-  Matrix  number 

1 

rows 

Matlc 

-  Matrix  number 

1 

columns 

Outputs 

i 

Mat2 

-  Matrix  result 

of 

'  transpose  Mat2 

Locals 

s 

Row 

-  Row  Index 

Col 

-  Column  Index 

Coupling  t 

None. 


References  s 
None. 

- } 


procedure  MatTrans  (  Natl 

Matlr, Matlc 
VAR  Mat2 

VAR 

Row, Col  i  Integer] 

BEGIN 

lnitHatrlx(  Hatlc,Natlr,Hat2  )i 
FOR  Row  i=l  to  Matlr  DO 

FOR  Col  i*  1  to  Matlc  DO 

Asslgnval(  Hat2,Col,Row,  GetVal(Hatl,Row,Col)  )j 
END;  (  Procedure  MatTrans  } 


t  Matrix; 
i  Integer  ) 
i  Matrix  )> 


=  u 


} 

{ 


PROCEDURE  LUDBCOHP 


This  procedure  decomposes  a  matrix  Into  an  LU  form. 

Algorithm  > 

Author  «  Haj  Tom  Rlgg*  USAFA/DFAS  719-472-4109  27  Apr  1989 

Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  1  Aug  1989 

Inputs  < 

Order  -  Order  of  matrix 

Outputs  t 

LU  -  LU  decomposition  matrix 

Index  -  Index  vector  for  pivoting 

Locals  s 

1  -  Index 

j  -  Index 

k  -  Index 

Imax  -  Pivot  row  pointer 

Scale  -  Scale  factor  vector 

Sum  -  Temporary  Variables 

AMax  -  Temporary  Variables 

Dum  -  Temporary  Variables 

Coupling  i 

None. 

References  i 

Numerical  Recipes  -  Flannery 


PROCEDURE  LUDeComp  (  VAR  LU  >  Matrix) 

VAR  Index  :  Intarrayi 

Order  <  INTEGER  ) ; 

Const 

Small  :  Extended  =  0.000001) 

Var 

I,  J,  K,  IMax  :  Integer) 

Scale  :  Matrix) 

Sum,  AMax,  Dum  t  Extended) 

BEGIN 

XnitMatrix(  Order, 1, Scale  )) 

IMax  «  =  0) 

FOR  I  i=  1  to  Order  do 
BEGIN 

AMax  s=  0.0) 

FOR  J  )=  1  to  Order  do 

IF  (Abs(CetVal(  LU, i , j) )  >  AMax)  THEN 
AMax  «*  Abe(GetVal(  LU,i,j)); 

IF  AMax  =0.0  tban 
BEGIN 

i  WriteC  Singular  Matrix  ')) 
halt) 

END) 

Assl'gnVal(  Scale, 1,1,  1.0  /  AMax  )) 

END) 

FOR  j  t=  1  to  Order  do 
BEGIN 

FOR  i  1=  1  to  )  -  1  do 
BEGIN 

Sum  1=  GetVal(  LU,l,j)) 

FOR  k  1=  1  to  1  -  1  do 

Sum  Sum  -  CetVal(  LU, i ,k)*GetVal(  LU.k, j) j 
AssignValJ  LU,i,j,  8um  )> 

END) 

AMax  t-  0.0) 

FOR  1  t=  j  to  Order  do 
BEGIN 

Sum  i=  GetValf  LU,i,j)> 

FOR  k  «=  1  to  j  -  1  do 

Sura  j=  Sum  -  GetVal(  LU, i,k)*GetVal(  LU,k,j)) 

AsslgnVal(  LU,l,j,  Cum  )> 

Dum  >=  GetValf  Beale, i,l  )*Abi(Su»)) 

I?  (Dum  >=  AMax)  then 
BEGIN 

lHax  )=  i) 

AMax  Dua> 

END) 

END) 

IF  (j  <>  Imax)  then 
BEGIN 

FOR  k  )=  1  to  Order  do 
BEGIN 

Dum  i=  GetVal(  LU,lmax,X)) 

AssignVal(  LU,laax,k,  GetVal(  LU,j,k  )  )) 

AssignValj  LU,j,k,  Dum  )) 

END) 

AssignVal(  Scale, imax, 1,  GetValf  Scale, j , 1 )  )i 
END) 

Indexlj)  i=  Imax) 

IF  Abs{GetVal(  LU , j , j ) )  <  Small  THEN 
BEGIN 

WriteC  Matrix  is  Singular  ')> 
halt) 

END) 

IF  (j  <>  Order)  THEN 
BEGIN 

Dum  t=  1.0  /  GetVal(  LU,j,j)) 

FOR  i  s=  j  +  1  to  Order  do 

As3ignVal(  LU,i,j,  Dura*GetVal{  LU,i,j)  )) 

END) 

END; 

DelHatrlx(  Scale  )) 

END)  {  Procedure  LuDeCap  } 

{ 


PROCEDURE  LUBkSUB 


} 

{ 

I  This  procedure  finds  the  invsrss  of  •  matrix  using  LU  decomposition. 
I  Algorithm  t 


Author 


Maj  Tom  Riggs  USAFA/DFAS  719-472-4109  28  Apr  1989 
Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  1  Aug  1989 


Inputs 

Order 

LU 

Index 


-  Order  of  matrix 

-  LU  decomposition  matrix 

-  Index  vector  for  pivoting 


Outputs 

B 


i 

-  Solution  Vector 


Locals 

i 


j 

10 

IPtr 

Sum 


-  Index 

-  Index 

-  Pointer  to  non-aero  element 

-  Pivot  Rwo  Pointer 

-  Temporary  Variables 


Coupling  i 

None. 

References  i 

Numerical  Recipes  -  Flannery 


} 


PROCEDURE  LUBkSub  (  LU  I 

Index  t 
Order  i 
Var  B  t 


VAR 

I,  J,  IPtr,  IOi  Integer | 

Sum  i  Extended) 

BEGIN 

10  i=  0) 

FOR  1  i*  1  to  Order  DO 
BEGIN 

IPtr  i*  Index! 1]; 

Sum  GetVal(  B,iPtr(l)j 
AsalgnVal(  B,Iptr,l,  GetValf  8,1,1)  )> 

IF  (10  <>  0)  then 

FOR  j  i=  10  to  i  -  1  do 

Sum  i=  Sum  -  GetVal(  LU,1, j)*CetVal(  B,j,l) 

ELSE 

IF  (Sum  <>  0.0)  THEN 
10  «=  I) 

AsslgnValf  B,l,l,  Sum  )) 

END) 


Matrix) 
Intarray) 
INTEGER) 
Matrix  )) 


AsslgnVal(  B, Order, 1,  GetVal(  B, Order, l)/GetVal(  LU, Order, Order)  )> 

FOR  l  i=  (Order  -  1)  Downto  1  DO 
BEGIN 

Sum  GetVal(  B,l,l)} 

POR  j  i=  l  +  1  to  Order  do 

Sum  i=  Sum  -  CetVal(  LU,1, j)*GetVal(  B,j,l)> 

AsslgnValf  B,i,l,  Sum  /  GetValf  LU,1,1)  )> 

END) 

END) 


{ 


raocnuM  matinverse 

This  procadura  finds  ths  lnvsrss  of  a  matrix  using  X<U  decomposition. 
Algorithm  » 

Author  t  Maj  Tosi  Higgs  U8AFA/DFA8  719-472-4109  28  Apr  1989 

Capt  Davs  Vallado  U8AFA/DTA*  719-472-4109  1  Aug  1989 

Inputs  t 

Mat  -  Matrix  to  invsrt 

Ordar  -  Ordar  of  Matrix 

OutPuts  i  1 

Hatlnv  -  Invartad  matrix 

Locals  i 

i  -  Indax 

j  -  Indax 

Indax  -  Indax  vactor  for  pivoting  I 

lu  -  lu  daoonposltlon  matrix  ' 

B  -  Oparatlonal  vactor  to  fora  Matlnv 

Coupling  t 

Mono. 

References  t 

Nuaarlcal  Recipes  -  Flannery 


PROCEDURE  Matinvarsa  (  Mat  i  Matrix* 

Ordar  t  integer* 

VAR  Matlnv  i  Matrix  )* 

VAR 

I,  J  i  Intagan 

Indax  i  Intarray* 

lu,b  i  Matrix) 

BEGIN 

XnltMatrlx(  Ordar, Ordar,  LU  )) 

InltMatrlx(  Ordar, 1,  B  j) 

lnitMatrlx(  ordar, Ordar,  Matlnv  )* 

FOR  1  i«  1  to  Ordar  DO 
BEGIN 

Indax(l]  i*  1| 
for  j  s*  l  to  Ordar  DO 

AsslgnVal(  LU,l,j,  OatVal(  Mat,l,j)  )) 

END) 

I 

LUDaCoop ( LU ,  Indax,  Ordar); 

FOR  j  «=  1  to  Ordar  DO 
BEGIN 

for  1  i=  l  to  Ordar  DO 
IF  (l  *  3)  THEM 

AsslgnVaK  B,i,l,  1.0  ) 

8L8E 

AsslgnVal(  B,l,l,  0.0  ); 

LUBk3ub(LU,  Indax,  Ordar,  B)i 

FOR  1  i=  1  to  Ordar  do 

AtsignVaM  Matlnv, i,j,  GatVal(  B,i,l)  )> 

END) 

DelHatr lx(  LU  ); 

DelHatr ix(  B  )* 

END;  {  Procedure  Matinvarsa  } 


{ 


PROCEDURE  PRINTHAT 


This  procadura  prints  a  matrix. 


Algorithm 


Author 

Inputs 

Natl 

Outputs 

Nona. 

Locals 

Row 

Col 

Coupling 

Nona. 


<  Writs  out  tha  tltla  for  tha  matrix 
Loop  through  tha  rows  and  print  out  1  row  at  a  tlma 

i  Capt  Dava  Vallado  U8AFA/DFA8  719-472-4109  11  Oct  1989 


Matrix  to  print  out 


-  Row  Indax 

-  Column  indax 


PROCEDURE  PrlntMat  {  Natl  i  Matrix) 

Tltla  i  8TR64  )) 

VAR 

Row, Col  i  Intagar) 

BEGIN 

Wrltaln(  Tltla  ); 

FOR  Rovt*  1  to  Natl* .NunRows  DO 
BEGIN 

FOR  Colts  1  to  Matr.NumCols  DO 
BEGIN 

Wrlta(  '  1 ,GatVal(  Natl, Row, Col)tl2i8  >) 

IF  (Col  MOD  6  =»  0)  and  (MatlA.NuaCola  >  6)  THEN 
BEGIN 
WrltaLni 
Wrlta(  '  1  )i 
END) 

END) 

Wrltaln) 

END) 

END)  {  Procadura  PrlntMat  } 


FUNCTION  DITERM INAPT 

This  function  calculatas  ths  dstsrmlnant  valu*  using  L-U  dacoapisltlon. 
The  formula  must  bavs  a  NON-ZERO  numbs r  in  ths  1,1  position.  IF  ths 
function  ssnsss  a  NON-ZERO  numbs r  in  row  1,  it  sxchangss  rowl  for  a  row 
WITH  a  NON-ZERO  numbsr.  1 

Author  t  Capt  Davs  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1968 

Inputs  t 

Ordar  -  Ordsr  of  datarminasnt  {#  of  rows) 

Natl  -  Matrix  to  find  datarainant  of 

Outputs  i 

Datarainant  -  Rasult 


Locals  ) 

1  -  indax 

j  -  Indax 

k  -  indax 

n  -  Indax 

Tsmp 
D 

8um 

L 

U 

Small  -  Tolarar<*a  for  compares  to  0.0 


Coupling 

Marlon 


pg.  161-172,  126-127 


} 


} 

FUNCTION  DETERMINANT  (  Natl  l  Matrix; 

Ordar  i  intagar  )  t  Extar.dad; 

CONST 

Snail  t  Bxtandad  3  0.000001; 

VAR 

l,j,k,n  ;  Intagar; 

Tamp,  D,  Sum  i  Bxtandad; 

Ii,  U  :  Matrix; 

BEGIN 

Sum  =  0.0; 

{ —  Switch  a  non  aaro  row  to  tha  first  row  — } 

IP  ABS(  GatVal(  Natl, 1,1  )  )  <  Snail  THEN 
BEGIN 
j»*  1> 

WHILE  j  <*  Ordar  DO 
BEGIN 

IP  ABS(  GatVal(  Katl, j,l  )  )  >  Small  THEM 
BEGIN 

FOR  k«  =  1  to  Ordar  DO 
BEGIN 

Tampi*  GatVal(  Matl,l,k  ); 

AssignVal(  Matl,l,k,  GatVal(  Matl.j.k  )  ); 

AsalgnVal(  Matl,j,k,  Tamp  ); 

END; 

j;=  Ordar  +  1; 

END; 

j»*  j+1; 

END; 

END;  {  IF  ABS(Matl( 1,1] )  <  Snail  } 

FOR  its  1  to  Ordar  DO 

AsslgnVal(  L,l,l,  GatValf  Natl, 1,1  )  ); 

FOR  j;*  1  to  Ordar  DO 

AsxlgnVaK  u,l,j,  GatVal(  Matl,l,j  )  /  GatVal(  L,l,l  )  ); 

FOR  j»*  2  to  Ordar  DO 
BEGIN 

FOR  it*  j  to  Ordar  DO 
BEGIN 

Sumi*  0.0; 

FOR  kt«  1  to  3-1  DO 

Sumi*  Sunt  GatVal(  L,l,k  )*  Catval(  U,k,j  ); 

AsslgnVal(  L.i,j,  GatVaK  Matl,i,j  )-  Sun  ); 

END;  {  for  I  } 

AssignVaM  U,j,j,  1.0  ); 

IF  j  <>  Ordar  THEN 
BEGIN 

FOR  li=  j+1  to  Ordar  DO 
BEGIN 

Sumi  =  0.0; 

FOR  k;=  1  to  j-1  DO 

Suai  =  Sun  +  GotVal(  L,j,k)*  GatVal(  U,k,l  ); 

A«»lgnVsl(  U,j,l,(  GatVal(  Matl, j,l)-8un)/  GatVal(  L,j,j  )  ); 

END;  {  for  i  } 

END;  {  if  j  } 

END;  {  for  j  ) 

Di=  1.0; 

FOR  li  =  1  to  Ordar  DO 

D»  =  D*  GatVal(  L,l,l); 

Detarmlnanti*  D; 

END;  {  Function  Datarnlnant  } 

{ 


} 


BEGIN, 

END.  {  Unit  Math  } 


APPENDIX  C 


FORTRAN  SOURCE  CODE 


TECHNICAL  ROUTINES 


Module  -  ASTROLIB.FOH 


This  fils  contains  fundamental  Astxodynamlc  Subtoutlnss  and  Functions. 

ui  mm  hi  iiiuum  tmim  im  mi  illinium 

1 1 1 1 1 1  USB  IN  ASTRO  C0UR8BS  IS  EJCPRESSLT  FORBIDDEN  1 1 1 1 1 1 
1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1  i  i  1 1 1 1  i  1 1 1 1 1 1 1 1 1 1 1 1 1  i  M 1 1 1 1 1 1 

*****************  NOTICE  OF  GOVERNMENT  ORIGIN  **************** 

This  software  has  been  developed  by  an  employee  of  the  United  States 
Government  at  the  United  States  Air  Force  Academy,  and  is  therefore 
a  work  of  the  United  States,  and  is  NOT  subject  to  copyright  protection 
under  the  provisions  of  17  U.8.C.  10S.  AMT  uss  of  this  work,  or 
inclusion  in  other  works,  must  comply  with  the  notice  provisions  of 
17  U.S.C.  403. 

**************************************************************** 


Author  i  Capt  Dave  Vallado,  USAFA  Dept  of  Astronautics 
Com!  719-472-4109,  Autovon  259-4109  /  4110 


Current  i  30  Jan  91  Capt  Dave  Vallado  VXR8XON  3.0 

Changes  i  28  Jan  91  Capt  Dave  Vallado 

25  Jan  91  Capt  Dave  Vallado 

Update  to  Uhey  Ver  3.0  /  FORTRAN  90 

20  Sep  90  Capt  Dave  Vallado  VERSION  2.1 

Nine  fixes  to  spesd  up 

20  Apr  90  capt  Dave  Vallado  version  2.0 

19  Dec  89  Capt  Dave  Vallado 
Version  1.4 

24  Apr  89  capt  Dave  Vallado 
Version  1,2 

12  Feb  89  Capt  Dave  Vallado 

Standardised  format 

28  Sep  88  Capt  Dave  Vallado 

Added  KMS  and  DMS  to  Rad  conversions 

30  Aug  88  Capt  Dave  Vallado  VERSION  1,0 


Subroutine  RadtoDMS 


Routines  toi  Technical  2-Body  calculation* 


Subroutine 

Site 

(  Let, Alt, Let, 

R8,V8 

) 

Subroutine 

RVToFOS 

(  Rho,A*,Bl,DRhO,DA*,DBl 

Rhovec,DRhovec 

) 

Subroutine 

Track 

(  Rho, Az,Bl,DRho,DAS,DBl,Lat ,Lst ,RS 
R»V 

) 

Subroutine 

RAZBL 

(  R,V,RS,Lat,Lst 

RhO,AZ,Bl, 

DRhO,DAz,DKl 

) 

Subroutine 

BLORB 

(  R,V 

P, A, K, Inc, Onega, 
Argp,Nu,M,U,L,CapPi) 

Subroutine 

RandV 

(  P,B, Inc, Onega, Argp,Nu,U,L,CapPl 

RiV 

) 

Subroutine 

Gibbs 

(  R1,R2,R3 

V2, Theta, fit 

) 

Subroutine 

HerrCibbs 

(  R1,R2,R3, JD1, JD2, JD3 

V2, Theta, fit) 

Subroutine 

FlndCandS 

(  ZNew 

CMew,SMew 

) 

Subroutine 

NewtonR 

{  B,M 

10,  Mu 

) 

Subroutine 

Kepler 

(  Ro, Vo, Tine 

a,v 

) 

Subroutine 

Gauss 

(  Rl,R2,DH,Tl*te 

VI, V2 

) 

Subroutine 

iJKtoLatLon 

(  R,JD 

GeoCnLat , Lon 

) 

Subroutine 

Sun 

(  JD 

R8un,RtAsc,Decl 

) 

Subroutine 

Moon 

(  JD 

RMoon,RtAsc,Decl 

) 

Subroutine 

PlanetRV 

{  NunPlanet,JD, 

R,V 

) 

Function 

Geocentric 

(  Lat 

) 

Function 

InvGeocentrlc  (  Lat 

) 

Subroutine 

Sight 

(  R1,R2, 

LOS 

) 

Subroutine 

Light 

(  R,JD, 

LIT 

) 

Subroutine 

OHS  2 

(  Lat, Lon, Alt, Phi 

, As, Speed, JD,  R, V 

) 

for  1CBM  calculati 

■””*  Rout ln»i 

Subroutine 

RngAz 

(  LLat ,LLon,TLat , 

TLon,TOF 

Range,  Az 

) 

Subroutine 

Path 

(  LLat,  LLon,  Range,  As 

TLat,  TLon 

) 

Subroutine 

Trajec 

(  LLat, LLon, TLat, 

TLon,Rbo,Q,TypePhl 

Range ,Phl,TOF, As , 

XCFhi , icvbo, iCRbo, VN  ) 


Routines  for  orbit  transfer  calculations 


} 


* 


* 

Subroutine 

Hohmann 

{ 

Rl,R3,el,e3,Mul, 

Nu3, 

* 

DelVa,DeiVb,TOP 

) 

* 

Subroutine 

OneTangent 

( 

Rl,R3,el,e3,Nul, 

Nu2,Nu3, 

* 

DelVa,DelVb,TOF 

) 

* 

Subroutine 

GeneralCoplanar(  Rl,R3,el,e2,e3, 

Nul,Nu2a,Nu2b,Nu3 

t 

* 

it 

DelVa,DelVb,TOF 

) 

* 

Subroutine 

Rendezvous 

( 

Rcsl,Rcs2,PhaseI 

,NumRevs 

* 

it 

PhaseF,WaitTime 

) 

* 

Subroutine 

Interplanetary( 

Rl,R2,Rbo,Rimpact,Mul,Mut ,Mu2, 

* 

it 

Deltavl,Deltav2, 

Vbo,Vretro  ) 

* 

it 

Subroutine 

Reentry 

< 

VHt#PhiRe/BC,H, 

V,Decl,MaxDecl 

) 

* 

it 

Subroutine 

HlllsR 

< 

RrVrlltftr 

R1,V1 

) 

* 

Subroutine 

HlllsV 

( 

R/  Alt  ft  t 

V 

) 

* 


Routines  for  Technical  perturbed  calculations 
-  and  numerical  integration  techniques  — 


Subroutine  Target 

Subroutine  PKepler 
Subroutine  J2DragPert 
Subroutine  Predict 

Subroutine  Derlv 
Subroutine  PertAccel 
Subroutine  PDerlv 
Subroutine  RK4 
Subroutine  ATHOS 
Subroutine  CHEBY 


(  Rlnt, Vint, RTgt,VTgt,D», TOP, 

Vlt,V2t,DVl,DV2  ) 

(  Ro, Vo, Time  R,V  ) 

(  Inc,B,N,NDot,  OmegaDOT, ArgpDOT, BDOT  ) 

(  JD,JDBpoch,no,Ndot,Bo,Bdot, lnco,Omegao, 
OmegaDot ,  Argpo,  ArgpDot  ,No,  lat ,  Lon ,  Alt , 

RtAsc,Decl,Rho,A*,*l  ) 


(  Tlme,X,  XDot  ) 
(  R,V,Th*e,WhlchOne,BC,  APert  ) 
(  Time,X,DerivType,BC,  XDot  ) 
(  XTime,DT,N,DerlvType,BC,  XDot  ) 
(  R,Rho  ) 
(  ALT,  PAlt.RhoAlt  ) 


-  CONSTANTS i  - 

Rad  =  57.29577951308230  Degrees  per  radian 

HalfPl  =  1.57079632679490 

PI  =  3.14159265358979 

TwoPi  =  6.28318530717959 


OmegaBarth 

s 

0.0588335906868878 

RadPerDay 

= 

6.30038809866574 

TUMln 

3 

13.44685108204 

TUDay 

= 

0.00933809102919444 

VXmPerSec 

- 

7.90S366296149 

EESqrd 

s 

0.00669437999013 

Flat 

= 

0.003352810664747352 

J2 

s 

0.00108263 

J3 

s 

-0.00000254 

J4 

z 

-0.00000161 

GHS 

= 

332952.9364 

GHH 

= 

0.01229997 

Angular  rotation  of  Barth  (Rad/TU) 
Radians  Barth  rotates  in  1  Sidereal  day 
Minutes  In  one  Time  Unit 
Days  per  Time  Unit 
KM/sec  in  one  DU/TU 

Xccentriclty  of  Barth's  shape  squared 
Flatenning  of  the  Barth 


Gravitational  Parameter  of  Sun  DU3/TU2 
Gravitational  Parameter  of  Moon  DU3/TU2 


SUBROUT INK  JULIANDAY 


Thl*  subroutine  finds  the  Julian  data  given  tha  Year ,  Month.  Day,  and  Tima. 
Tha  Julian  data  la  defined  by  aach  alapsad  day  tinea  noon,  1  Jan  4713  BC. 
Julian  datas  are  maasured  from  thla  apoch  at  noon  so  astronomers 
observations  may  be  performed  on  a  single  “day*.  The  yaar  range  Is 
limited  since  machine  routines  for  36S  days  a  year  and  leap  years  are 
valid  in  this  range  only.  This  Is  due  to  the  fact  that  leap  years  occur 
only  In  years  divisible  by  4  and  centuries  whose  number  Is  evenly 
divisible  by  400.  (  1900  no,  2000  yes  ...  ) 

NOTBt  This  Algorithm  Is  taken  from  tha  1988  Almanac  for  Computers, 

Published  by  tha  U.S.  Naval  Observatory.  The  algorithm  Is  good  for  dates 
between  1  Mar  1900  to  28  Fab  2100  since  tha  last  two  terms  (from  the 


Almanac) 

are  commented  out. 

Algorithm 

i  Find  the  various  terms  of 
Calculate  the  answer 

the  expansion 

Author 

t  Capt  Dave  Vallado  U8AFA/DFA8  719-472-4109  12  Aug  1988 

Inputs 

t 

Yr 

-  Year 

1900  ..  2100 

Hon 

-  Honth 

1  ..  12 

D 

-  Day 

1  ..  28,29,30,31 

H 

-  Universal  Time  Hour 

0  ..  23 

M 

-  Universal  Time  Nln 

0  ..  59 

Sec 

-  Universal  Time  Sec 

0.0  ..  59.999 

Outputs 

i 

JD 

-  Julian  Date 

days  from  4713  B.C 

Locals 

i 

Terml 

-  Temporary  REAL  value 

Term2 

-  Temporary  INTEGER  value 

Term3 

-  Tecporary  INTEGER  value 

UT 

-  Universal  Time 

days 

Constants 

i 

Nona. 

Coupling 

t 

Nona. 

References 

i 

1988  Almanac  for  Computers  pg.  B2 
Escobal  pg.  17-19 

Kaplan  pg.  329-330 


SUBROUTINE  jullanDay  (  Yr,Hon,D,H,H,S,  JD  ) 
IMPLICIT  NONE 
INTEGER  Yr,Mon,D,H,H 
REAL* 8  S,JD 


-  Locals 

REAL* 8  UT.Terml 
INTEGER  Term2,Term3 


-  Implementation  - 

TERM1  =  367. ODO  *  Yr 

TERM2  =  INT(  (7*  (Yr+INT  (  (Hon+9)/12)  )  )  /  4  ) 
TBRH3  =  INT(  275*Hon  /  9  ) 

UT  =  (  (S/60. ODO  +  H  )  /  60. ODO  +  H  )  /  24.0DC 

JD  =  (TERM1-TERM2*TERM3)  +  D  +  1721013. 5D0  +  UT 
RETURN 
END 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

It 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

<1 


SUBROUTINE  DAYOFYR2MDHMS 


This  subroutine  converts  the  day  of  ths  ysar,  fractional  days,  to  ths  month 
day,  hour,  minuts  and  sscond. 


Algorithm  <  Sst  up  array  for  ths  number  of  days  per  month 

loop  through  a  temp  value  while  the  value  is  <  ths  days 
Perform  integer  conversions  to  the  correct  day  and  month 
Convert  remainder  into  HNS  using  type  conversions 

Author  t  Capt  Dave  Vallado  USAFA/w’AS  719-472-4109  26  Feb  1990 


Inputs  i 

Yr  -  Year 

Days  -  Julian  Day  of  the  year 


1900  ..  2100 
0.0  ..  366.9 


Outputs 

Non 

D 

H 

M 

Sec 


-  Month 

-  Day 

-  Hour 

-  Minute 

-  Second 


1  ..  12 

1  ..  28,29,30,31 
0  ..  23 
0  ..  59 
0.0  ..  59.999 


Locals  t 

dayyr  -  Day  of  year 

Temp  -  Temporary  real  values 

IntTemp  -  Temporary  Integer  value 

i  -  Index 


days 


Constants  i 

LMonth(12]  -  Integer  Array  containing  the  number  of  days  per  month 

Coupling  > 

None. 


SUBROUTINE  DAYOFYR2KDHM8  (  Yr,DayS,  Hon,D,H,M,S  ) 
IMPLICIT  NON* 

REAL* 8  Days.S 

INTEGER  Yr,  Mon,  D,  H,  M 


-  Locals  - - - 

INTEGER  IntTemp, l,DayYr 
REAL* 8  Temp,  LMonth(12) 

-  Set  up  array  of  days  in  month  - 

DO  1=1,12 

LHonth(i)  =  31 
ENDDO 

LHonth(  2)  =  28 
LHonth(  4)  =  30 
LHonth{  6)  =  30 
LMonth(  9)  =  30 
LKonth(U)  =  30 
DayYr  =  AINT(  Days  ) 

-  month  and  Day  of  month  - 

IP  (  INT(  HOD(  Yr-1900,4  )  J.EQ.O  )  THEN 
LHonth(2)=  29 
ENDIF 
i=  l 

IntTemp=  0 

DO  WHILE  (  (DayYr .GT. IntTemp+LHonth( 1 ) ) .and. ( i.LT.12) ) 
IntTemp=  IntTemp  +  LHonth(i) 

1=  1 U 
ENDDO 
Mon  =  i 

D  =  DayYr  -  IntTemp 

-  Find  hours  minutes  and  seconds  - 

Temp=  (Days  -  DayYr  )*24.0D0 
H  =  DINT(  Temp  ) 

Temp=  (Temp-H  )  *  60.000 
M  =  DINT(  Temp  ) 

S  =  (Temp-M  )  *60.000 


RETURN 

END 


SUBROUTINE  RAZEL 


Thl«  Subrout ln«  calculates  Rang*  Azimuth  and  Elevation  and  thair  rataa  glvan 
the  Geocentric  Equatorial  (IJK)  Position  and  Velocity  vectore. 


Algorithm 


Author 

Inputs 

R 

V 

Lat 

LST 

RS 

Outputs 

Rho 

Az 

El 

DRho 

DAz 

DEI 

Locals 

RhoV 

DRhoV 

RhoVec 

DRhoVec 

WCrossR 

EarthRata 

TempVec 

Temp 

Tempi 

Small 

i 


Constants 

HalfPl 

Pi 

OmegaEarth 


t  Find  constant  values 
Loop  to  find  range  and  velocity  vectors 
Rotate  to  find  SEZ  vectors 

Use  If  statments  to  find  As  and  El  including  special  cases 
t  Capt  Dave  Vallado  USAFA/DPA8  719-472-4109  27  Mar  1990 


-  ijk  Position  Vector 

-  IJK  Velocity  Vector 

-  Geodetic  Latitude 

-  Local  Sidereal  Time 

-  IJK  Site  Position  Vector 


DU 

DU  /  TU 

-Pl/2  to  Pl/2  rad 
-2P1  to  Pi  rad 
DU 


-  Satellite  Range  from  site 

-  Azimuth 

-  Elevation 

-  Range  Rate 

-  Azimuth  Rate 

-  Elevation  rate 


DU 

0  to  2P1  rad 
-Pi/2  to  Pl/2  rad 
DU  /  TU 
rad  /  TU 
rad  /  TU 


i 

-  IJK  Range  Vector  from  site  DU 

-  IJK  Velocity  Vector  froai  site  DU  /  TU 

-  SEZ  Range  vector  from  site  DU 

-  siz  Velocity  vector  from  site  DU 

-  Cross  product  result  DU  /  TU 

-  IJK  Earth's  rotation  rate  vector  rad  /  TU 

-  Temporary  vector 

-  Temporary  REAL  value 

-  Temporary  REAL  value 

-  Tolerance  for  roundoff  errors 

-  Index 


: 

-  Angular  rotation  of  Earth  (Rad/TU) 


1.57079632679490 

3.14159265358979 

0.0588335906868878 


Coupling  i 

Hag  Magnitude  of  a  vector 

Cross  Cross  product  of  two  vectors 

Rot 3  Rotation  about  the  3rd  axis 

Rot 2  Rotation  about  the  2nd  axis 

Dot  Dot  product  of  two  vectors 


References  t 

BMW  pg.  84-89,  100-101 


SUBROUTINE  FINDDAYS 


This  subroutine  finds  the  fractional  days  through  a  ysar  given  the  year, 
month,  day,  hour,  minute  and  second. 

Algorithm  t  Set  up  array  for  the  number  of  days  per  month 
Check  for  a  leap  year 
Loop  to  find  the  elapsed  days  in  the  year 


* 

* 

Author 

s 

Capt  Dave  Vallado  USAFA/dfas  719- 

-472-4109 

11  Dec 

* 

Inputs 

: 

* 

Yr 

- 

Year 

1900  .. 

2100 

* 

Mon 

- 

Month 

}  .. 

12 

* 

D 

- 

Day 

1  .. 

28,29,: 

* 

H 

- 

Hour 

0  .. 

23 

* 

M 

- 

Minute 

0  .. 

59 

* 

ft 

Sec 

- 

Second 

0.0  .. 

59.999 

* 

Outputs 

: 

* 

* 

days 

- 

Day  of  year  plus  fraction  of  a  day 

days 

t 

Locals 

t 

* 

* 

i 

* 

Index 

* 

Constants 

t 

* 

ft 

None. 

* 

Coupling 

: 

* 

ft 

None. 

* 

References 

i 

* 

None. 

SUBROUTINE  FlndDays(  Tear, Month, Day, Hr, Kin, Sec,  Days  ) 
IMPLICIT  NONE 

INTEGER  Year, Month, Day, Hr, Min 
REAL*8  Sec,  Days 


INTEGER  i,LNonth(12) 


-  Set  up  array  of  days  in  month  - 

DO  1=1,12 

LHonth(l)  =  31 
END  DO 

LMonth(  2)  =  28 
month (  4)  =  30 
LHonth(  6)  =  30 
LMonth(  9)  =  30 
LHonth(ll)  =  30 

IF  (  I»r(  M0D(  Year-1900,4  )  ).EQ.O  )  THEN 
LHonth<2)=  29 
END  IF 
1  =  1 
Day 3=  0.0D0 

DO  WHILE  ( (l. It. Month). and. (  l.lt.12  )) 

Days=  Days  +  LMonth(i) 

1=  1  +  1 
ENDDO 

Days=  Days  +  Day  +  Hr/24.0D0  +  Hln/1440.OD0  +  Sec/86400. 0D0 

RETURN 

END 


*  C  4  * 


FUNCTION  GSTIME 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

« 

* 


This  function  finds  the  Graanwich  Sidereal  time.  Notica  just  tha  integer 
part  of  tha  Julian  Data  ia  usad  for  tha  Julian  canturias  calculation. 

Algorithm  <  Perform  expansion  calculation  to  obtain  tha  answer 
Check  tha  answer  for  tha  correct  quadrant  and  size 

Author  ;  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  12  Feb  1989 


Inputs 

JD 


l 

-  Julian  Data 


days  from  4713  B.C. 


Outputs 

GSTime 


i 

-  Graanwich  Sidaraal  Time 


0  to  2Pi  rad 


Locals 

Temp 

Tu 


-  Temporary  variable  for  Reals 

-  Julian  Canturias  from  1  Jan  2000 


rad 


Constants  t 

TwoPi 

RadPerDay  -  Rads  Barth  rotates  in  1  Solar  Day 

Coupling  i 

None. 


6.28318530717959 

6.30038809866574 


References  i 

1988  Astronomical  Almanac  pg.  B6 
Bscobal  pg.  18  -  21 

Explanatory  Supplement  pg.  73-75 
Kaplan  pg.  330-332 

BMW  pg.  103-104 


REAL* 8  FUNCTION  GSTime  {  JD  ) 
IMPLICIT  NONE 
RKAL*8  JD 


-  Locals  - 

real* 8  Temp,  Tu,  RadPerDay,  TwoPi 

-  Implementation  - 

RadPerDay*  6.3003880936657400 
TwoPi  =  6.283185307179S9D0 

Tu  =  {  DINT(JD)  +  0.5DO  -  2451545. 0D0  )  /  36525. 0D0 
Temp*  1.753368559D0  +  628.3319705D0*Tu+6.770708127D-06*Tu**2+ 
&  RadPerDay*DBLE(  JD-DINT(JD)-0.5  ) 

-  Check  quadrants  - 

Temp  =  DHOD(  Temp, TwoPi  ) 

IF  (  Temp.LT.O.ODO  )  THEN 
Tamp  =  Temp  +  TwoPi 
ENDIF 

GSTime*  Temp 
RETURN 
END 


*  C-5  • 


* 

* 

* 


FUNCTION  GSTIMO 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


?his  tun: Non  find*  the  Greenwich  Sidereal  tine  at  the  beginning  of  a  year. 
This  formula  is  derived  from  the  Astonoolcal  Almanac  and  is  good  only  for 
0  hr  UT,  1  Jan  of  a  year. 


Algorithm 

Author 

Inputs 

Yr 

Outputs 

GSTimO 


:  Find  the  Julian  Date  Ref  4713  BC 
Perform  expansion  calculation  to  obtain  the  answer 
Check  the  answer  for  the  correct  quadrant  and  siae 

i  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  12  Nov  1989 


-  Year  1988,  1989,  etc. 


-  Greenwich  Sidereal  Time  0.0  to  2Pi  rad 


Locals 

JD 

Temp 

Tu 


-  Julian  Date  days  from  4713  B.C. 

-  Temporary  variable  for  Reals  rad 

-  Julian  Centuries  from  1  Jan  2000 


Constants 

TwoPi 


6.28318530717959 


Coupling  : 

None. 


References  < 

1988  Astronomical  Almanac  pg.  B6 
Escobal  pg.  18  -  21 

Explanatory  Supplement  pg.  73-75 
Kaplan  pg.  330-332 

BMW  pg.  103-104 


REAL* 8  FUNCTION  GSTimO  (  Yr  ) 
IMPLICIT  NONE 
INTEGER  Yr 


-  Locals  - 

REAL* 8  JD,  Temp,  Tu,  TWOPI 

-  Implementation  - 

TwoPi  =  6 . 28318530717959D0 

JD  =  367. 0D0  *  Yr  -  (  IMT( (7*(Yr+INT(10/12) ) )/4)  )  + 

&  <  INT( 275/9)  )  +  1721014. 5D0 

Tu  =  {  INT(JD)  +  O.SDO  -  2451545. 0D0  )  /  36525. 0D0 
Temp=  1. /53368559D0  +  628. 3319705D0*Tu  +  6.770708127D-06‘Tu**2 

-  Check  quadrants  - 

Temp  =  DMOD(  Temp, TwoPi  ) 

IP  (  Temp.LT.O.ODO  )  THEN 
Temp  »  Temp  +•  TwoPi 
ENDIF 

GSTlmO=  Temp 
RETURN 
END 


*  c  6  • 


SUBROUTINE  LSTIHE 


This  subroutine  finds  the  Local  Sidereal  tine  at  a  given  location. 


* 

Algorithm 

>  Find  GST  through  the  routine 

* 

i, 

Find  LST  and  check  for  size  and  quadrant 

* 

* 

Author 

>  Capt  Dave  Vallado  U8AFA/DFAS 

719-472-4109  12  Aug  1988 

* 

Inputs 

> 

* 

Lon 

-  Site  longitude  (WEST  -) 

-2P1  to  2P1  rad 

* 

it 

JD 

-  Julian  Date 

days  from  4713  B.C. 

* 

Outputs 

t 

* 

LST 

-  Local  Sidereal  Time 

0.0  to  2Pi  rad 

* 

h 

GST 

-  Greenwich  Sidereal  Time 

0.0  to  2Pi  rad 

* 

Locals 

> 

Constants 

TwoPl 

Coupling 

GSTime 

References 

Escobal 

Kaplan 

BMW 


-  Finds  the  Greenwich  Sidereal  Time 


pg.  18  -  21 
pg.  330-332 
pg.  99  -100 


6.28318530717959 


SUBROUTINE  LSTlme  (  Lon.JD,  LET, GST  ) 
IMPLICIT  NONE 
REAL* 8  Lon.JD,  LST,  G8T 
EXTERNAL  GSTime 


REAL* 8  TwoPi .GSTime 


Locale 


-  Implementation 

TwoPl  =  6.28318530717959170 

GST  =  GSTlme{  JD  ) 

LST  =  Lon  +  GST 


-  Check  quadrants 

LST  =  DH0D(  LST.TwoPi  ) 

IF  (  LST.LT.0.0D0  )  THIN 
LST  =  LST  +  TWOPI 
ENDIF 
RETURN 
END 


*  C-7  * 


SUBROUTINE  SUNRISKSKT 


*  This  subroutine  finds  the  Universal  time  for  Sunrise  and  Sunset  given  the 

*  day  and  site  location.  Note  the  use  of  degrees  and  radians  since  the 

*  Almanac  presents  the  algorithm  in  these  units. 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


Algorithm 


U*.  «  case  atat.rn.nt  to  a.t  th.  angl.  from  th.  tun  to  alt. 
Find  days,  and  than  th.  valu.a  for  UT  times 


Author  :  Capt  Dav.  Vallado  UBAFA/DFA8  719-472-4109  13  Jan  1991 


Inputs 

JDate 

tat 

ton 

WhlchKlnd 


-  Julian  Data 

-  Sita  latitude  (SOUTH  -) 

-  Sit.  longitude  (WIST  -) 

-  Character  for  which  riae/aet 


days  from  4713  B.C. 
-Pi/2  to  Pi/2  rad 
-2P1  to  2P1  rad 
■S'  'C'  'N'  'A* 


Outputs  : 

UTSunRise  -  Universal  time  of  sunrise  at  lat-lon  hra 

UTSunSat  -  Universal  tlaM  of  sunset  at  lat-lon  hra 


Locals 

t 

Constants 

Rad 


i 


t 


Days  from  the  beginning  of  the  year 
Radians  par  degree 


Coupling  i 

XnvJullanDay  Finds  the  Yr  Da  Hn  Hr  Hi  Sa  from  the  Julian  Data 
FlndDays  Finds  the  days  from  1  Jan  of  a  year 


References  s 

Almanac  For  Computers  1990  pg.  BS-86 


} 


SUBROUTINE  SUNRISESET ( JDa  te , Lat , Lon , Wh ichK ind , UTSunRi se , UTSunSet ) 
IMPLICIT  NONE 

REAL* 8  JDa te, La t , Lon, UTSunRlaa , UTSunSet 
CHARACTER  WhichKlnd 

REAL*  8  Z, t, m, 1, ra,aindelt«, delta, h, sec, days, Rad, TwoPi, Pi 

INTEGER  year, month, day, hr, min 

Rad  =  57.29577951308230D0 
TwoPi  =  6 . 28318S30717959D0 
Pi  =  3, 141 59 26 53 5897 9D0 
IF  (WhichKlnd. aq. 'S'  )  THEN 

Z=  ( 90 . ODO+50 . 0D0/60 . ODO  )/Rad 
ELSEIF  (WhichKlnd. aq. 'C' )  THEN 
Z=  96. ODO  /  Rad 
ELSEIF  (WhichKlnd. aq. 'N' )  THEN 
Z=  102. ODO  /  Rad 
ELSEIF  (WhichKlnd. aq. 'A')  THEN 
Z=  108. ODO  /  Rad 
ENDIP 

CALL  lnvJulianDay(  JData,  Year, Month, Day, Hr, Min, Sac  ) 

CALL  FindDays(  Year, Month, Day, Hr, Min, Sac,  Days  ) 

-  Sunriae  - 

t  =  Days  +  (6. ODO  -  Lon*Rad/15.0DQ)/24.0D0 
M  =  0.985600D0*t  -  3.289D0 

L  =  H  +  1.916D0*DSin(  H/Rad  )  F  0.020DO*DSln(  2.0D0*M/Rad  )  + 

&  282.634D0 

L  *  DMOD(  L, 360.0  ) 

Ra*  DATan(  0.91746DQ*DTan(L/Rad)  ) 

IF  (Ra.lt.O.ODO)  THEN 
Ra=  Ra  +  TwoPi 
END IF  i 

IF  (  (L.gt. 180. ODO). and. (Ra.lt. Pi)  )  THEN 
Ra=  Ra  +  Pi 
END  IF 

IF  (  (L. It .180. ODO) .and. (Ra.gt.Pi )  )  THEN 
Ra*  Ra  -  Pi 
END  IF 

SinDelta*  0.39782D0*DSln(  L/Rad  ) 

Delta  =  DASln(  SinDelta  ) 

H=  DACoa (  (DCos(z)  -  SlnDalta*D8in(Lat) )  / 
s  ( DCos ( Delta )*DCo»( Lat)  )  ) 

H=  TwoPi  -  H 

t=  H*Rad/15.0D0  +  RA*Rad/15.QD0  -  0.065710DO*t  -  6.622D0 
T=  DMOD(  T,  24. ODO  ) 

UTSunRlaa*  T  -  Lon*Rad/15.0D0 
UTSunRlaa*  DMOD(  UTSunRlaa,  24. ODO  ) 

IF  (UTSunRise.lt.O.ODO)  THEN 

UTSunRlaa*  24. ODO  *  UTSunRlaa 
ENDIF 


-  Sunaat  - 

t  =  Days  +  (18. ODO  -  Lon*Rad/15.0D0)/24.0D0 
M  =  0.985600DO*t  -  3.2B9D0 

L  =  M  +  1 . 916D0*DSln(  H/Rad  )  +  0 . O2OD0*DSln(  2.0D0*H/Rad  )  + 
&  282.634D0 

L  =  DMOD(  L, 360.0  ) 

Ra*  DATan(  0.91746D0*DTan(L/Rad)  ) 

IF  (Ra.lt.O.ODO)  THEN 
Ra=  Ra  +  TwoPi 
ENDIF 

IF  (  (L.gt. 180. ODO). and. (Ra.lt. Pi)  )  THEN 
Ra=  Ra  +  Pi 
ENDIF 

IF  (  (L. It. 180. ODO). and. (Ra.gt.Pi)  )  THEN 
Ra*  Ra  -  Pi 
ENDIF 

SinDelta*  0. 39782D0*DSin(  L/Rad  ) 

Delta  *  DASin(  SinDelta  ) 

H=  DACos (  (DCos(z)  -  SlnDelta*DSin(Lat) )  / 
i  ( DCos ( Delta )*DCos( Lat)  )  ) 

H=  TwoPi  -  H 

t=  H*Rad/15.0D0  +  RA*Rad/15.0D0  -  0.065710DO*t  -  6.622D0 
T=  DMOD(  T,  24. ODO  ) 

UTSunSet*  T  -  Lon*Rad/15.0D0 
UTSunSat*  DMOD(  UTSunSet,  24. ODO  ) 

IF  ( UTSunSet. lt.O. ODO)  THEN 
UTSunSet*  24. ODO  +  UTSunSat 
ENDIF 

RETURN 

END 


*  C-9  * 


SUBROUTINE  HHSTOUT 


* 

* 


* 

*  This  subroutine  converts  Hours/  Minutes  and  Seconds  into  Universal  Time. 

* 


* 

Algorithm 

>  Calculate  the  answer 

* 

Author 

i  Capt  Dave  Vallado  U8AFA/DFA8 

719-472-4109 

12  Aug  1988 

* 

Inputs 

: 

* 

Hr 

-  Hours 

0  ..  24 

ex.  2 

* 

Min 

-  Minutes 

0  ..  59 

ex.  39 

* 

Sec 

-  Seconds 

0.0  ..  59.! 

99  ex.  57.29 

* 

Outputs 

t 

* 

UT 

-  Universal  Time 

HrMin.Sec 

ex. 239. 5729 

t 

Locals 

t 

* 

None. 

* 

Constants 

* 

* 

None. 

* 

Coupling 

; 

* 

None. 

SUBROUTINE 

HMStoUT  (  Hr, Min, Sec,  UT  > 

IMPLICIT 

NONE 

REAL *8  UT.Sec 

INTEGER  Hr, Min 

UT  =  Hr*100.0D0  +  Min  +  3ec/100.0D0 

RETURN 

END 

* 

* 

SUBROUTINE  UTTOHM8 

* 

This  subroutine  converts  Universal  Tine  into  Hours,  minutes 

and  seconds. 

* 

Algorithm 

i  Calculate  the  answer 

* 

Author 

i  Capt  Dave  Vallado  USAFA/DFAS 

719-472-4109 

12  Aug  1988 

* 

Inputs 

l 

* 

UT 

-  Universal  Time 

HrMin.Sec 

ax. 239. 5729 

* 

Outputs 

t 

* 

Hr 

-  Hours 

0  ..  24 

ex.  2 

* 

Min 

-  Hinutes 

0  ..  59 

ex.  39 

* 

Sec 

-  Seconds 

0.0  ..  59.! 

99  ex.  57.29 

* 

Locals 

: 

* 

None. 

* 

Constants 

i 

* 

None. 

* 

Coupling 

i 

* 

* 

* 

None . 

SUBROUTINE  UTtOHHS  (  UT,  Hr,Min,Sec  ) 
IMPLICIT  NONE 
REAL*8  UT.Sec 
INTEGER  Hr, Min 


-  Implementation 

Hr  =  IDINT(  UT/100.0D0  ) 

Mln=  IDINT(  UT-HrUOO.ODO  ) 

Sec=  {  UT-DINT(UT)  )  *  100. 0D0 
RETURN 
END 


*  C-10  * 


SUBROUTINE  HHSTORAD 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

♦ 

* 

* 

* 

♦ 

* 


This  subroutine  converts  Hours,  minutes  and  seconds  into  radians.  Notice 
the  conversion  0.2617  is  simply  the  radian  equivalent  of  15  degrees. 

Algorithm  :  Calculate  the  answer 

Author  t  Capt  Dave  Vallado  U8APA/DFAS  719-472-4109  6  Sep  1988 

Inputs  : 

Hr  -  Hours  0  ..  24  ex.  10 

Min  -  Minutes  0  ..  59  ex.  15 

Sec  -  Seconds  0.0  •  •  59.99  ex.  30.00 

Outputs  : 

KMS  -  Result  rad  ex.  2.6856253 

Locals  : 

None. 

Constants  t 

None. 

Coupling  i 

None. 


SUBROUTINE  HMStoRad  (  Hr, Min, Sec,  KMS  ) 

IMPLICIT  NONE 
REAL* 8  KMS, Sec 
INTEGER  Hr, Min 

-  Implementation  - 

HHS=  (  Hr  +  Mln/60.0D0  f  8ec/3600.0D0  )*0.261799387D0 

RETURN 

END 


4 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

4 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


SUBROUT INK  RADTOHHS 

This  subroutine  converts  radians  into  Hours,  minutes  and  seconds.  Notice 
the  conversion  0.2617  is  simply  ths  rsdlan  equivalent  of  15  d.gre.a. 

Algorithm  t  Convert  incoming  radians  to  hours 
Calculate  ths  answer 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  8  Sap  1988 

Inputs  i 

KMS  -  Result  rad  ex.  2.6856253 

Outputs  I 

Hr  -  Hours 

Hln  -  Minutes 

Sec  -  Seconds 

Locals  t 

Temp  -  Temporary  variable  to  hold  and  change  KMS  value 

Constants  t 

Hone. 

Coupling  i 

None. 


0  ..  24  sx.  10 
0  ..  59  ex.  15 
0.0  ..  59.99  ex.  30.00 


SUBROUTINE  RadtoHMS  (  HMS,  Hr, Min, Sec  ) 
IMPLICIT  HONE 
REAL ‘8  KMS, Sec 
INTEGER  Hr, Min 
REAL* 8  Temp 

-  Implementation 

Temp  =  HMS  /  0.261799387DO 
Hr  =  IDINT(  Temp  ) 

Hln  =  IDIHT(  (Temp-Hr)*60.0D0  ) 

Sec  =  ( Tamp-Hr -H in/60, 0D0  )  *  3600. 0D0 

RETURN 

END 


*  C-1J  * 


SUBROUTINE  HHSTORAD 


This  subroutine  converts  Hours,  minutes  and  seconds  into  radians.  Notice 
the  conversion  0.2617  is  simply  the  radian  equivalent  of  15  degrees. 


Algorithm  t  Calculate  the  answer 


Author 

i  Capt  Dave  Vallado  U8APA/DPAS 

719-472-4109 

6  Sep 

1988 

Inputs 

Hr 

i 

-  Hours 

0  ..  24 

ex. 

10 

Hin 

-  Minutes 

0  ..  59 

•X. 

15 

Sec 

-  Seconds 

0.0  ..  59.99 

•X. 

30.00 

Outputs 

HMS 

t 

-  Result 

rad 

ex.  2 

.6856253 

locals  i 

None. 


Constants  t 

None. 

Coupling  i 

None. 


SUBROUTINE  HHStoRad  (  Hr, Min, Sec,  HMS  ) 

IMPLICIT  NONE 
RIAL* 8  HMS, Sec 
INTEGER  Hr, Min 

-  Implementation  - 

HMS-  (  Hr  +  Mln/60.0D0  +  Sec/3600. 0D0  )»0.261799387D0 

RETURN 

END 


SUBROUTINE  RADTOHMS 

This  subroutine  converts  radians  into  Hours,  minutes  and  seconds.  Notice 
the  conversion  0.2617  is  simply  the  radian  equivalent  of  15  degrees. 


Algorithm 


Author 

Inputs 

HMS 

Outputs 

Hr 

Min 

Sec 

Locals 

Temp 

Constants 

None. 

Coupling 

None. 


t  Convert  incoming  radians  to  hours 
Calculate  the  answer 

i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109 


t 

-  Result 


-  Hours 

-  Minutes 

-  Seconds 


rad 


8  Sep  1988 
ex.  2.6856253 


0 

0 

0.0 


24 

59 


ex. 

ex. 


59.99  ex. 


10 

15 

30.00 


t 


Temporary  variable  to  hold  and  change  HMS  value 


SUBROUTINE  RadtoHMS  {  HMS,  Hr, Min, Sec  ) 
IMPLICIT  NONE 
REAL *8  HMS, Sec 
INTEGER  Hr, Min 
REAL* 8  Temp 

-  Implementation 

Temp  =  HMS  /  0. 261799387D0 
Hr  =  IDINT(  Temp  ) 

Min  =  IDINT(  (Temp-Hr)*60,ODO  ) 

Sec  =  ( Temp-Hr -H l n/6 0 , 0D0  )  *  3600. 0D0 

RETURN 

END 


*  C-Il  * 


* 


* 

*  SUBROUTINE  SITE 

* 

*  This  Subroutine  finds  the  position  and  velocity  vectors  for  a  site.  The 

*  answer  Is  returned  In  the  Geocentric  Equatorial  (IJK)  coordinate  system. 

* 


*  Algorithm 

* 

* 


* 

*  Author 

* 

*  Inputs 

*  tat 

*  Alt 

*  1ST 

* 

*  Outputs 

*  RS 

*  VS 

* 

*  Locals 

*  EarthRate 

*  SlnLat 

*  Temp 

*  x 

*  z 

* 

*  Constants 

*  EBSqrd 

*  OmegaEarth 


*  Coupling 

*  Mag 

*  Cross 

*  References 

*  Escobal 

*  Kaplan 

*  BMW 


>  Set  up  constants 
Find  x  and  s  values 
Find  position  vector  directly 
Call  cross  to  find  the  velocity  vector 

»  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


-  Geodetic  Latitude 

-  Altitude 

-  Local  Sidereal  Time 


-Pi/2  to  Pi/2  rad 
DU 

-2P1  to  2P1  rad 


i 

-  IJK  Site  position  vector  DU 

-  IJK  Site  velocity  vector  DU  /  TU 

i 

-  IJK  Earth's  rotation  rate  vector  rad  /  TU 

-  Variable  containing  sln(  Let  )  rad 

-  Temporary  RIAL  value 

-  x  component  of  site  vector  DU 

-  s  component  of  site  vector  DU 


-  Eccentricity  of  Earth's  shape  squared  0.00669437999012 

-  Angular  rotation  of  Earth  (Rad/TU)  0.0588335906666878 


Magnitude  of  a  vector 
Cross  product  of  two  vectors 


pg.  26  -  29  (Includes  Geocentric  Let  formulation  also) 
pg.  334-336 
pg.  94  -  98 


* 


SUBROUTINE  Site  (  Lat,Alt,Lst,  R8,VS  ) 

IMPLICIT  NONE 

REAL* 8  Lat,  Alt,  LST,  RS(4),  VS(4) 

-  Locals  - 

REAL* 8  SlnLat,  Temp,  x,  s,  EarthRate{4) , OmegaEarth, EB8qrd 

-  Initialise  Variables  - 

OmegaEarth  =  0.O588335906868878D0 
EESqrd  =  0.006 6 9 43799 901 3D0 
SlnLat  =  DSIN(  Lat  ) 

EarthRate (1)=  O.ODO 
EarthRate(2)-  0.0D0 
BarthRate(3)=  OmegaEarth 


*  -  Find  v  and  z  components  of  site  vector 

Temp  *  D8QRT(  1.0D0  -  (  EESqrd*SinLat**2  )  ) 

x  =  (  {  1 . ODO/Teaip  )  +  Alt  )*DC03(  Lat  ) 

z  =  (  (<l.OD0-EBSqrd)/Temp)  +  Ait  )*8inLat 

*  -  Find  8lte  position  vector  - 

RS( 1 )  =  X  *  DCOS(  LSt  ) 

RS{ 2)  =  X  *  DSIN(  Lat  ) 

RS(3)  =  Z 


CALL  HAG{  RS  ) 


-  Fin<j  site  velocity  vector 

CALL  CROS8(  EarthRate, as, V8  ) 

RETURN 

END 


*  C-13  * 


SUBROUTINE  SITE 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


) 


This  Subroutine  finds  the  position  and  velocity  vectors  for  a  site.  The 
answer  is  returned  in  the  Geocentric  Equatorial  (UK)  coordinate  system. 


Algorithm  »  Set  up  constants 

Find  x  and  s  values 

Find  position  vector  directly 

Call  cross  to  find  the  velocity  vector 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


Inputs 

Lat 

Alt 

1ST 


t 

-  Geodetic  Latitude 

-  Altitude 

-  Local  Sidereal  Time 


-Pi/2  to  Pi/2  rad 
DU 

-2Pi  to  2Pl  rad 


Outputs 

RS 

VS 


-  IJK  Site  position  vector 

-  UK  Site  velocity  vector 


DU 

DU  /  TU 


Locals 

EarthRate 

SinLat 

Temp 

x 

z 


i 

-  uk  Earth's  rotation  rate  vector 

-  Variable  containing  sln(  Lat  ) 

-  Temporary  RIAL  value 

-  x  component  of  site  vector 

-  s  component  of  site  vector 


rad  /  TU 
rad 


DU 

DU 


EB8qrd*  -  Eccentricity  of  Earth's  shape  squared  0.00669437999013 
OmegaEarth  -  Angular  rotation  of  Earth  (Rad/TU)  0.0588335906868878 


Coupling 

Mag 

Cross 


Magnitude  of  a  vector 
Cross  product  of  two  vectors 


References 

Escobal 

Kaplan 

BHW 


pg.  26  -  29  (Includes  Geocentric  Lat  forawlatlon  also) 
pg.  334-336 
pg.  94  -  98 


SUBROUTINE  Site  (  Lat, Alt, Let,  R8,VS  ) 

IMPLICIT  NONE 

REAL* 8  Lat,  Alt,  L8T,  RS<4),  V3{4) 

*  -  Locals  - 

REAL* 8  SinLat,  Temp,  x,  s,  EarthRate{4) , OmegaEarth, BK8qrd 

*  -  Initialise  Variables  - 

OmegaEarth  =  0.O588335906868878D0 
EESqrd  =  0.0066 943799 9013D0 

SinLat  =  DSIN(  Lat  ) 

EarthRate(l)=  O.ODO 
EarthRate(2)=  O.ODO 
EarthRate(3i=  OmegaEarth 

*  -  Find  v  and  z  components  of  site  vector  - 

Temp  *  DSQRT(  1.0D0  -  (  EKSqrd*SinLat**2  )  ) 

x  =  (  (  l.ODO/Tesip  )  +  Alt  )*DC0S(  Lat  ) 

z  =  (  ( (i.0D0-EESqrd)/Temp)  +  Ait  )*SinLat 

*  -  Plnd  Site  position  vector  - 

RS(1)  =  x  *  DCOS(  Lst  ) 

RS<2)  =  x  *  DSIN(  Lst  ) 

RS( 3)  =  a 

CALL  MAG (  RS  ) 


«  -  Find  Site  velocity  vector 

CALL  CROS8(  EarthRate, RS, VS  ) 

RETURN 

END 


*  C-13  * 


SUBROUTINE  TRACK 


* 

* 


This  Subroutine  finds  range  and  velocity  vectors  in  the  Geocentric  Equatorial 
(IJK)  system  given  the  following  input  from  a  radar  site. 


Algorithm  :  Find  constant  values 

Pind  SEZ  vectors  from  RVToPOS 
Rotate  to  find  IJK  vectors 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


Inputs 

l 

Rho 

-  Satellite  range  from  site 

Az 

-  Azimuth 

El 

-  Elevation 

DRho 

-  Range  Rate 

DAZ 

-  Azimuth  Rate 

DEI 

-  Elevation  rate 

Lat 

-  Geodetic  Latitude 

LST 

-  Local  Sidereal  Time 

RS 

-  IJK  Site  position  vector 

DU 

0.0  to  2Pi  rnd 
-Pi/2  to  Pi/2  rad 
DU  /  TU 
rad  /  TU 
rad  /  TU 

-Pl/2  to  Pl/2  rad 
-2P1  to  2P1  rad 
DU 


Outputs 

R 

V 


IJK  Satellite  position  vector 
IJK  Satellite  velocity  vector 


DU 

DU  /  TU 


Locals 

HCrossR 

RhoVec 

DRhoVec 

TempVec 

Rhov 

DRhoV 

ERate 


-  Cross  product  result 

-  SEZ  range  vector  from  site 

-  SBZ  velocity  vector  froei  site 

-  Temporary  vector 

-  IJK  range  vector  fro*  site 

-  IJK  velocity  vector  fro*  site 

-  IJK  Earth's  rotation  rate  vector 


DU  /  TU 
DU 

DU  /  TU 
DU 

DU  /  TU 
rad  /  tu 


Constants  i 

HalfPi 

OmegaEarth  -  Angular  rotation  of  Earth  (Rad/TU) 


1.57079632679490 

0.0588335906868878 


Coupling 
RVTOPOS 
Cross 
Addvac 
Rot  3 
Rot  2 
MAG 


Find  R  and  V  fro*  site  in  Topocentrlc  Horlaon  (SEZ)  system 

Cross  product  of  two  vectors 

Add  two  vectors  together 

Rotation  about  the  3rd  axis 

Rotation  about  tta  2nd  axis 

Magnitude  of  a  vector 


References 

EHW 


I 

pg.  85-89,  100-101 


SUBROUTINE  Track  (  Rho, As , K1  ,DRhc,DA? , DEI , Lat , Lst ,RS,  R,V  ) 
IMPLICIT  NONE 

REAL* 8  Rho, Az, El ,DRhO,DAs,DEl ,Lac,Lst ,RS( 4) ,R( 4) ,V( 4) 

-  Locfils  - 

REAL* 8  WCrossR(4) ,  RhoVec(4),  DRhoVec(4),  TempVec(4),  RhoV(4), 

(  DRhoV ( 4 ) ,  KRate( 4 ) ,Half Pi, OmegaKarth 

-  Initialise  Variables  - 

Half Pi  *  1 . 5707963267949000 

OmegaEarth  =  O.O5883359O6868878D0 

BRate(l)  *  0.000 

ERate(2)  =  0.0D0 

ERate(3)  =  OmegaEarth 

-  Find  SEZ  range  and  velocity  vectors  - 

CALL  RVTOPOS (  Rho.AZ, El, DRhO.DAZ, DEI, RhoVeC, DRhoVec  ) 

-  Perform  8BZ  to  IJK  transformation  - 

CALL  ROT2(  RhoVoc  ,Lat-HalfPi,  TempVec  ) 

CALL  ROT3(  TempVec,  -LST  ,  RhoV  ) 

CALL  R0T2(  DRhoVec, Lat-Half Pi,  TeatpVec  ) 

CALL  ROT3(  TempVec,  -LST  ,  DRhoV  ) 

-  Find  IJK  range  and  velocity  vectors  — - — - - 

CALL  ADDV8C(  RhoV,RS,R  ) 

CALL  CROSS(  ERate, R  .WCrossR  ) 

CALL  ADDVEC(  DRhoV, NCroSSR,V  ) 

RETURN 

END 


♦  c-15  * 


*  SUBROUTINE  RAZEL 

* 

*  This  Subroutine  calculates  Rang*  Azimuth  and  Elevation  and  their  rates  given 

*  the  Geocentric  Equatorial  (IJK)  Position  and  Velocity  vectors. 

* 

*  Algorithm  i  Find  constant  values 

*  Loop  to  iind  range  and  velocity  vectors 

*  Rotate  to  find  SEZ  vectors 

*  Use  if  statments  to  find  Az  and  El  including  special  cases 


Author 

»  Capt  Dave  Vallado  USAFA/DFAS  719- 

472-4109  27  Mar  1990 

Inputs 

. 

R 

-  IJK  Position  Vector 

DU 

V 

-  IJK  Velocity  Vector 

DU  /  TU 

Lat 

-  Geodetic  Latitude 

-Pl/2  to  Pl/2  rad 

LSI 

-  Local  Sidereal  Time 

-2P1  to  Pi  rad 

RS 

-  IJK  Site  Position  Vector 

DU 

Outputs 

• 

Rho 

-  Satellite  Range  from  site 

DU 

Az 

-  Azimuth 

0  to  2P1  rad 

El 

-  Elevation 

-Pl/2  to  Pl/2  rad 

DRho 

-  Range  Rate 

DU  /  TU 

DAz 

-  Azimuth  Rate 

rad  /  TU 

DEI 

-  Elevation  rate 

rad  /  TU 

Locals 

i 

RhoV 

-  IJK  Range  Vector  from  site 

DU 

ERhoV 

-  IJK  Velocity  Vector  from  site 

DU  /  TU 

RhoVec 

-  sez  Range  vector  from  site 

DU 

DHhoVec 

-  SEZ  Velocity  vector  from  site 

DU 

WCrossR 

-  Cross  product  result 

DU  /  TU 

EarthRate 

-  IJK  Earth's  rotation  rate  vector 

rad  /  TU 

TempVec 

-  Temporary  vector 

Temp 

-  Temporary  REAL  value 

Tempi 

-  Temporary  REAL  value 

Small 

-  Tolerance  for  roundoff  errors 

1 

-  Index 

Constants 

i 

HalfPl 

1.57079632679490 

Pi 

3.14159265358979 

OmegaEarth 

-  Angular  rotation  of  Earth  (Rad/TU) 

0.0588335906868878 

Coupling 

i 

Hag 

Magnitude  of  a  vector 

Cross 

Cross  product  of  two  vectors 

Rot  3 

Rotation  about  the  3rd  axis 

Rot  2 

Rotation  about  the  2nd  axis 

Dot 

Dot  product  of  two  vectors 

References 

i 

BMW 

pg.  84-89,  100-101 

SUBROUTINE  RAZEL  (  R,V,RS,Lat,Lst,  Rho,A*,El,DRho,DAa,D21  ) 
IMPLICIT  NONE 

REAL* 8  R(4),V(4),RS(4),Lat,Lst,Rho,Az,El,DRho,DAz,DEl 
EXTERNAL  DOT 


*  -  Local*  - 

REAL* 8  RhoV(4),  DRhoV(4),  RhoVec(4),  DRhoVec(4),  WCro**R(4), 

i  ERate(4),  TempVac(4),  Tamp,  Small, HalfPl, Pi, Tampl, 

&  OmagaEarthfDot 


INTEGER  1 


*  -  Inltlallza  Variablai 

Pi  =  3, 1 4159 26 5 35897  9D0 

HalfPl  =  1. 57079632679490D0 


Omagalarth  =  0.0588335906868878D0 

ERata(l)  =  0.0D0 

ERata(2)  =  O.ODO 

ERate(3)  =  OaegaEarth 


Small  =  O.OOOOOIDO 

*  -  Find  IJK  range  vector  from  site  to  satellite 


CALL  CROSS (  ERate,R,WCro**R  ) 

DO  1=1,3 

RhoV(l)  =  R(l)  -  RS( 1) 
DRhoV(l)=  V(l)  -  WCrossR(l) 
END  DO 

CALL  MAG(  RhoV  ) 

Rho=  RhoV ( 4 ) 


*  -  Convert  to  SIX  for  calculations  - 

CALL  ROT3(  RhoV  ,  LST  ,  TempVec  ) 

CALL  ROT2(  TempVec, Half Pl-Lat,  RhoVec  ) 

CALL  ROT3(  DRhoV ,  LOT  ,  TempVec  ) 

CALL  ROT2(  TempVec, HalfPi-Lat,  DRhoVec  ) 

*  -  Calculate  Azimuth  and  Elevation  - 

Temp  =  DSQRT (  RhoV*cjl)**2  +  RhoVec(2)**2  ) 

IF  (  DABS(  RhoVec(2)  ).LT. Small  )  THEN 
IF  (  Temo.LT. Small  1  THEN 

Tempi  =  DSQRT (  DRhoVec<i)**2  +  DRhoVec(2)**2  ) 

Az  =  DAT AN 2 (  DRhoVec<2)/Templ  ,  -DRhoVec ( 1 ) /Tempi  ) 
ELSE 

IF  (  RhoVec (1). car. O.ODO  )  THEN 
Az  =  Pi 
ELSE 

As  =  O.ODO 
ENDIF 
END  IP 

ELSE 

Az  =  DATAN2(  RhoVec( 2 )/Temp  ,  -RhoVec (1)/Temp  ) 

ENDIF 

IF  (  Temp. LT. Small  )  THEN 
El  =  HalfPl 
ELSE 

El  =  DATAN2(  RhoVac(3)/Rho  ,  Temp/Rho  ) 

ENDIF 


*  -  Calculate  Range,  Azimuth  and  Elevation  rates  - 

DRho=  DOT(  RhoV, DRhoV  )  /  Rho 
IP  (  DABS (Temp). GT. Small  )  THEN 

DAa  a  (  DRhoVec ( 1 ) ‘RhoVec ( 2 )  -  DRhoVec(2)*RhoVec(l)  )  / 
&  (Temp** 2) 


ELSE 

DAz=  O.ODO 
ENDIF 

IP  (  DABS(Temp) .GT.O.OOOOOOOOIDO  )  THEN 

DEI  =  (  DRhoVec(3)  -  DRho*DSIN(  El  )  )  /  Temp 
EL8E 

DBi=  O.ODO 
ENDIF 
RETURN 
END 


*  C  17  * 


SUBROUTINE  ELORB 

This  Subroutine  finds  the  classical  orbital  elements  given  the  Geocentric 
Equatorial  Position  and  Velocity  vectors.  Special  cases  for  equatorial 
and  circular  orbits  are  also  handled.  I F  elements  are  infinite/  they 
are  set  to  999999.9.  If  elements  are  Undeflr.ixJ,  they  are  set  to  999999.1. 
Be  sure  to  check  for  these  during  output II 


Algorithm 


Author 


*  Inputs 

*  R 

*  V 


Outputs 


:  Inltialse  variables 

If  the  Hbar  magnitude  exists/  continue,  otherwise  exit  and 
assign  undefined  values 
Find  vectors  and  values 

Determine  the  type  of  orbit  with  IF  statements 
Find  angles  depending  on  the  orbit  type 

i  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  20  Sep  1990 


-  IJK  Position  vector 

-  UK  Velocity  vector 


DU 

DU  /  TU 


p 

-  Semi-latus  rectum 

DU 

A 

-  semi-major  axis 

DU 

Ecc 

-  eccentricity 

Inc 

-  inclination 

C.O 

to  Pi  : 

rad 

Omaga 

-  Longitude  of  Ascending  Node 

0.0 

to  2Pi 

rad 

Argp 

-  Argument  of  Perigee 

0.0 

to  2P1 

rad 

Nu 

-  True  anomaly 

0.0 

to  2P1 

rad 

H 

-  Mean  Anomaly 

0.0 

to  2P1 

rad 

U 

-  Argument  of  Latitude 

(Cl) 

0.0 

to  2P1 

rad 

L 

-  True  Longitude 

(Cl) 

0.0 

to  2P1 

rad 

CapPl 

-  Longitude  of  Per  laps is 

(EX) 

0.0 

to  2P1 

rad 

Locals 

i 

Hbar 

-  Angular  Momentum  H  Vector 

DU2 

/  TU 

Ebar 

Nbar 

cl 

RDotV 

c3 

Small 

SHE 

1 

E 

D 

P 

Temp 

TypeOrbit 

Constants 

HalfPl 

Pi 

TwoPl 

Infinite 

Undefined 

Coupling 

HAG 

CROSS 

DOT 

DACOSH 

ANGLE 

References 

BHW 

Bscobal 

Kaplan 


E  Vector 
M  Vector 


-  Eccentricity 

-  Line  of  Nodes 

-  V**2  -  u/R 

-  R  Dot  V 

-  Hk  unit  vector 

-  Tolerance  for  roundoff  errors 

-  Specfic  Mechanical  Energy 

-  index 

-  Eccentric  Anomaly 

-  Parabolic  Eccentric  Anomaly 

-  Hyperbolic  Eccentric  Anomaly 

-  Temporary  value 

-  Type  of  orbit 


-  Flag  for  an  lnflntlte  element 

-  Flag  for  an  undefined  clement 


DU2  /  TU2 

rad 

rad 

rad 

EE,  KI,  CE,  Cl 


1.57079632679490 

3.14159265358979 

6.28318530717959 

999999.9 

999999.1 


Hagnitude  of  a  vector 
Cross  product  of  two  vectors 
DOT  product  of  two  vectors 

inverse  Double  Precision  Hyperbolic  Cosine  Function 
Angle  between  two  vectors 


pg.  58  -  71 
pg.  104-107 
pg.  29  -  37 


*  C-18  * 


% 


SUBROUTINE  ELORB  {  R,V,  P,A,Bcc,Inc,Omega,Argp,Nu,K,U,L,CapPi  ) 
IKPLICIT  NONE 

RBAL*8  R{4),V(4)/P,A,Sco,Inc,0»*ga,Afgp,Nu,K#U,X.,C#pI'l 
EXTERNAL  DOT,DACOSH 


*  -  Local*  - 

REAL* 8  cl,RDotV,c3,Small,SHl»Hbar(4) ,Ebar (4) ,Nbar(4) ,TwoPl, 
&  HalfPi, Pi, Dot , Undefined, Inf ini t*,E,P,D,DACoab, Temp 

INTEGER  1 

CHARACTER* 2  TypeOrbit 

*  -  Inltialli*  Variable*  - 

Pi  =  3.14159265358979DO 

HalfPi  =  1 .5707963267949000 
TWOP1  =  6.28318530717959D0 
Small  =  0.000001D0 
Infinite  »  999999. 9D0 
Undefined  =  999999. 1D0 
CALL  HAG(  R  ) 

CALL  HAG(  V  ) 

*  -  Find  h  h  and  B  vector*  - 

CALL  CROSS (  R,V,Kbar  ) 

IF  (  HBar(4).GT. Small  )  THEN 
Nbar(l)*  -Hbar(2) 

Nbar{2)=  Hbar(l) 

Nbar(3}=  0.0D0 
CALL  HAG(  Nbar  ) 

Cl*  V(4)**2  -  l.SD0/R(4) 

RDOtV=  DOT(  R,V  ) 

DO  1=  1,3 

Ebar(l)=  cl*R(i)  -  RDotV»V(l) 

END  DO 

CALL  MAG(  Ebar  ) 

*  -  Find  a  *  and  semi-latus  rectum  - - - 

SMK=  (  V(4)**2  /  2.0D0  )  -  {  1.0D0/R(4)  ) 
ir  (  DABS(SHE) .GT. Small  )  THEN 
A«  -1.000  /  (2.0D0*8HS) 

ELSE 

A*  Infinite 
BNDIF 

Kcc*  Ebar(4) 

P*  HBar(4)**2 


*  -  Find  inclination  - 

c3=  HBar(3)/HBar(4) 

ir  (  DABS(  DABS(C3)-1.0D0  ).LT. Small  )  THEN 
IF  (  DABS(Hb»r (3) ) .GT.O.ODO  )  THEN 
c3=  DSIGN(  1.000, Hbar(3)  ) 

BNDIF 

BNDIF 

Inc*  DACOS (  c3  ) 

*  -  Determine  type  of  orbit  for  later  uie  — 

TypeOrbit*  '81' 

IF  (  BCC.LT. Small  )  THEN 


*  - Circular  Equatorial - 

IP  ((  Inc, LT. Small  ),or.{  DABS (Inc-Pi).LT. Small  ))  THEN 
TypeOrbit*  'CB' 

ELSE 

*  -  Circular  Inclined  - 

«•  TypeOrbit*  'Cl' 

BNDIF 

ELSE 

*  -  Elliptical,  Parabolic,  Hyperbolic  Equatorial  - 

IF  ((  Inc. LT. Small  >,or.(  ABS(Inc-Pi).LT. Small  ))  THEN 
k  TypeOrbit*  'BE' 

BNDIF 

BNDIF 

* 


*  C  19  * 


-  Find  Longitude  of  Ascanding  Nod* 

IF  (  NBar(4)  .GT. Small  )  THEN 
Temp=  Nbar(l)  /  NBar(4) 

IF  (  DAB8(Tamp) . gt . 1 . 0D0  )  THEN 
Tamp  c  D8IGN(  l.ODO.Tamp  ) 

ENDIF 

Omega*  DAC08 {  Temp  ) 

IF  (  NEar(2)  .M.O.ODO  )  THEN 
Oa»ga=  TwoPl  -  Omega 
ENDIF 

ELSE 

Omi<ga=  Undefined 
ENDIF 


-  Find  Argument  of  perigee 

IF  (  TypeOrbit.eq. 'SI*  )  THEN 

CALL  ANCLE(  NBar,EBar,  Argp  ) 

IF  (EBar{3) . LT.0.0D0)  THEN 
Argp=  TwoPl  -  Argp 
ENDIF 

ELSE 

Argp=  Undaflnad 
ENDIF 


-  Find  Tru*  Anomaly  at  Epoch  - 

IF  (  TypeOrblt(lil) .eq. 'B'  )  THEN 
CALL  ANGLB(  EBar,R,  Nu  ) 

IF  (RDotV.LT.O.ODO)  THEN 
NU1  TwoPl  -  MU 
ENDIF 

ELSE 

Nu-  Undefined 
ENDIF 

—  Find  Argument  of  Latltuda  -  Circular  Incllnad  - 

IF  (  TypaOrblt.EQ. 'Cl'  )  THEN 
CALL  ANGLE (  NB*r,R,  U  ) 

IF  (R(3*.LT.O.ODO)  THEN 
U=  TwoPl  -  U 
ENDIF 

ELSE 

•J=  Undaflnad 
ENDIF 

Find  Longltuda  of  Parlgaa  -  Elliptical  Equatorial  - 

IF  ((  EBar(4).GT. Small  ).and.(  TypaOrblt.EQ. ’IE'  ))  THEN 
Tamp  =  BBar(l)/EBar(4) 

IF  (  DABS(Temp) .gt.l.ODO  )  THEN 
Tamp  =  DSIGN(  l.ODOfTanp  ) 

ENDIF 

CapPl=  DACOSC  Tamp  ) 

IF  (Ebar(2).LT.O.ODO)  THEN 
CapPl=  TwoPl  -  CapPi 
ENDIF 

IP  (Inc.GT.HalfPl)  THEN 
CapPi =  TwoPl  -  CapPi 
ENDIF 

ELSE 

CapPl=  Undaflnad 
ENDIF 

-  Find  True  Longltuda  -  Circular  Equatorial  - 

IF  ((  R( 4) .GT. Small  ) .and. {  TypaOrblt.EQ. 'CB'  ))  then 
Tamp  =  R(l)/R(4) 

IF  (  DABS(Teap). gt.l.ODO  )  THEN 
Temp  =  D8IGN(  1.0D0,Tecp  ) 

ENDIF 

L=  DAC03(  Tamp  ) 

IF  (R(2) .LT.O.ODO)  THEN 
L*  TwoPl  -  L 
ENDIF 

IP  (Inc.GT.HalfPl)  THEN 
L=  TwoPl  -  L 
ENDIF 

ELSE 

L=  Undaflnad 
ENDIF 


*  C-20  • 


-  Find  Haan  Anomaly  tor  all  orbits  - 

- Hyparbollc  - 

IF  ((Scc-l.ODO).GT. Small)  THEN 

F=  DACOSH (  ( KCC+DCOS ( Ku ) )/(1.0DQ+Bcc*DCoi(NU) )  ) 
M=  Ecc*DSinh(  F  )  -  F 
ELSE 


-  Parabolic  - 

IF  (  (DABS(  ECC-1.0D0  ) ) .LT. Small  )  THEN 
D  =  DSQRT(  p  )  *  DTan(  NU  ) 

M  =  (1.0D0/6.0D0)*(  3.0D0*p*D  +  D**3  ) 
ELSE 


-  Elliptical  - 

IF  (  Ecc.GT. Small  )  THEN 

Temp=  1.0D0  +  ecc*DCos(Nu) 

IF  (  DABS (Tamp). It. Small  )  then 
H  =  O.ODO 
ELSE 

cl  =  (  D8GRT(1.0DO-Scc**2)*D8ln(Nu)  )  /  Tamp 
c3  =  (  Bcc  +  DCos(Nu)  )  /  Tamp 
IF  (  DABS(cl) .gt .1.0D0  )  THEN 
Cl  2  DSIGN(  l.ODO.Cl  ) 

ENDIF 

IF  (  DABS(c3) .gt.l.ODO  )  THEN 
c3  2  DSIGN(  1.0D0,c3  ) 

ENDIF 

E  =  DATan2 (  clic3  ) 

H  =  B  -  BCC*D8in{  E  ) 

ENDIF 

ELSE 


-  Circular  - 

IF  (  TypeOrbit.EQ.  ’CE‘  )  THEN 
M  «  L 
ELSE 
M  *  U 
ENDIF 

ENDIF 

ENDIF 

ENDIF 

IF  (  M.lt. O.ODO  )  THEN 
M  *  M  +  TvoPl 
ENDIF 

Hrita(  *,20  )  *H  2  ' ,Hbar(l) ,Hbar(2) ,Hbar{3) ,Hbar(«) 
Write!  *.20  )  ‘N  2  1 ,Nbar(l),Nbar(2) ,Nbar(3) ,Nbar(4) 
Write!  *,20  )  'E  «  • ,Ibar(l) ,Ebar(2) ,*bar(3) ,Bbar<4) 
Write!  *,*  )  1  SHE*  1 , SHE, 1  DU2/TU2' 

20  FORMAT)  A4,2X,4(F13.7)  ) 

ELSE 

p  =  Undaflned 
A  *  Undefined 
Ecc  2  Undefined 
Inc  2  Undefined 
Omega2  Undefined 
Argp  2  Undefined 
Nu  2  Undefined 
H  3  Undefined 
U  2  Undefined 
l  =  Undefined 
CapPl2  Undefined 
ENDIF 
RETURN 
END 


SUBROUTINE  RANDV 


This  Subroutine  finds  ths  position  and  velocity  vectors  in  Geocentric 
Equatorial  (IJK)  system  given  the  classical  orbit  elements.  NOTICE 
p  is  used  for  calculations  and  that  semi  major  axis,  a,  is  not.  This 
convention  allows  parabolic  orbits  to  be  treated  as  well  as  the  other 
conic  sections.  Notice  the  special  cases  leave  Argp,  Omega  and  Mu  equal 
to  zero,  rather  than  setting  them  to  som  large  number  as  a  flag  for 
Infinite  or  undefined.  This  allows  the  routine  to  process  different  types 
of  orbits  with  ONE  transformation  matrix  since  zeros  will  leave  the  vectors 
unchanged  during  that  phase  of  the  transformation. 


Algorithm 


*  Author 


Inputs 


i  Select  the  type  of  orbit  through  IP  statements 
and  assign  Omega,  Argp,  and  Nu 

Although  these  values  change,  they  are  NOT  passed  back 
Find  the  PQW  position  and  veocity  vectors 
Rotate  by  3-1-3  to  IJK.  Order  is  important 

t  Capt  Dave  Vallado  USAFA/DfAS  719-472-4109  20  Sep  1990 


* 

p 

-  Seal-latus  rectum 

DU 

* 

E 

-  eccentricity 

0.0  to  ... 

* 

Inc 

-  Inclination 

0.0  to  Pi 

rad 

★ 

Omega 

-  Longitude  of  Ascending  Mode 

0.0  to  2P1 

rad 

* 

Argp 

-  Argument  of  Perigee 

0.0  to  2P1 

rad 

* 

Nu 

-  True  anoautly 

0.0  to  2P1 

rad 

* 

U 

-  Argument  of  Latitude  (Cl) 

0.0  to  2P1 

rad 

* 

I. 

-  True  Longitude  (CE) 

0.0  to  2Pl 

rad 

* 

ft 

CapPi 

-  Longitude  of  Perlapsis  (EE) 

0.0  to  2P1 

rad 

* 

Outputs 

i 

* 

R 

-  IJK  Position  vector 

DU 

* 

* 

V 

-  IJK  Velocity  veator 

DU  /  TU 

* 

Locals 

i 

* 

Temp 

-  Temporary  REAL  value 

ft 

Small 

-  Tolerance  for  roundoff  errors 

ft 

Rpqw 

-  PQW  Position  vector 

DU 

* 

Vpqw 

-  PQ«  velocity  vector 

DU  /  TU 

* 

* 

TempVec 

-  PQW  velocity  vector 

* 

Constants 

i 

* 

ft 

Pi 

3.141592653585 

* 

Coupling 

i 

* 

HAG 

Hagnltude  of  a  vector 

* 

ROT  3 

Rotation  about  the  3rd  axis 

* 

ft 

ROT1 

Rotation  about  the  1st  axis 

ft 

References 

i 

ft 

BMW 

pg.  71-73,  80-83 

ft 

Escobal 

pg.  68-83 

*  c-22  * 


SUBROUTINE  RandV  (  P,K, Inc, Omega, Argp,Nu,U,L,CapPi,  R,V  ) 
IMPLICIT  MOHS 

REAL *8  P,*,Inc,Omega,Argp,Nu,U,L,CapPi,R(4) ,V(4) 

-  Local*  - 

REAL* 8  Temp,  Small, Rpqv(4),  Vpqv(4),  TempVec(4),  PI 

-  Inltlalla*  variable*  - 

Small  =  0.00000100 
Pi  =>  3.14159265358979D0 


Determine  what  typ*  o£  orbit  i*  involved  and  a*t  up  tha 
sat  up  angles  for  tha  spaclal  caaas. 


IP  (  E.LT. Small  )  THEN 

-  Circular  Equatorial  - 

IP  ((  Inc. LT. Small  ) .or. (  AB8(Inc  -  Pi). LT. Small  ))  THEN 
Argp  =  0.000 
Omega =  0.0D0 
Nu  =  L 

-  Circular  Inclined  - 

ELSE 

Argp=  O.ODO 
Nu  =  U 
ENDIF 

ELSE 

-  Elliptical  Equatorial  - 

IF  ((  Inc. LT. Small  }.or.(  ABO ( Inc  -  Pi). LT. Small  ))  THEN 
Argp  =  Cappl 
Omaga=  O.ODO 
ENDIF 
ENDIF 


-  Form  PQW  position  and  velocity  vectors 

Temp=  P  /  (l.ODO  +  8*DC0S(NU) )  • 

Rpqv(l)=  Temp*DCOS(NU)  ! 

Rpqw(2)=  Tamp*DSIN(NU) 

Rpqv(3)*  O.ODO 
Vpqv(l)=  -DSIN(NU)/DSQRT(P) 

Vpqv(2)=  (E  +  DCOS(NU) )  /  DSQRT(P) 

Vpqv(3)=  O.ODO 
CALL  HAG(  Rpqv  ) 

CALL  MAG(  Vpqv  ) 

-  Perform  transformation  to  IJX  - 

CALL  ROT3(  Rpqv  ,  -Argp  ,  TeapVec  ) 

CALL  ROT1 (  TerapVec,  -Inc  ,  TampVec  ) 

CALL  ROT3<  TampVac,  -Omega,  R  ) 

CALL  ROT3(  Vpqv  ,  -Argp  ,  TampVac  ) 

CALL  R0T1(  TampVac,  -Inc  ,  TampVac  j 

CALL  ROT3(  TampVac,  -Omega,  V  ) 

RETURN 

END 


SUBROUTINE  GIBBS 


This  Subroutine  performs  ths  Gibbs  method  of  orbit  determination.  This 
method  determines  the  velocity  at  the  middle  point  of  the  3  given  position 
vectors.  Several  flags  are  passed  back. 

Fit  *  0  ok 

Fit  -  1  not  coplanar 
Fit  3  2  orbit  is^osslble 

The  Gibbs  method  is  best  suited  for  coplanar,  sequential  position  vectors 
which  are  more  than  about  10  deg  apart.  Notice  the  angle  is  passed  back 
so  the  user  may  make  a  decision  about  the  accuracy  of  the  calculations  as 
vectors  which  are  120  deg  apart  stay  be  accurate,  while  vectors  8  deg 
apart  would  not.  The  method  will  calculate  the  resulting  velocity  using 
the  vectors  IN  THS  ORDER  GIVEN.  IF  the  calculations  are  not  possible, 

V2  is  set  to  0.0.  Notice  a  1  deg  tolerance  is  allowed  for  the  coplanar 
check.  This  is  necessary  to  allow  for  noisy  data  in  the  estimation  project. 

Algorithm  i  Initialise  values  including  the  answer 

Find  if  the  vectors  are  coplanar,  else  set  a  flag 
Check  that  the  orbit  is  possible,  else  set  a  flag 
Find  the  largest  angle  between  the  vectors 
Calculate  the  answer 


Author 

: 

Capt  Dave  Vallado  U8AFA/DPA8  719-472- 

-4109  21 

Inputs 

t 

R1 

- 

IJK  Position  vector  fl 

DU 

R2 

- 

IJK  Position  vector  <2 

DU 

R3 

- 

IJK  Position  vector  (3 

DU 

Outputs 

> 

V2 

- 

IJK  Velocity  Vector  for  R2 

DU  /  TU 

Theta 

- 

Angle  between  the  two  vectors 

rad 

Fit 

- 

riag  indicating  success 

0,  1,  2 

Locals 

i 

tover2 

- 

1 

- 

Small 

- 

Tolerance  for  roundoff  errors 

rlmr2 

- 

Magnitude  of  rl  -  r2 

r3mrl 

- 

Magnitude  of  r3  -  rl 

r2mr3 

- 

Magnitude  of  r2  -  r3 

P 

- 

P  Vector  r2  x  r3 

q 

- 

Q  Vector  r3  x  rl 

w 

- 

W  Vector  rl  x  r2 

d 

- 

D  Vector  p  +  q  +  w 

n 

- 

N  Vector  (rl)p  t  (r2)q  ♦  (r3)w 

s 

- 

S  Vector  (r2-r3)rl+(r3-rl)r2+(rl-r2)r3 

b 

- 

a  Vector  d  r  r2 

Thetal 

- 

temporary  angle  between  the  two  vectors  rad 

PN 

- 

P  Unit  Vector 

R1N 

- 

Rl  Unit  Vector 

dn 

- 

D  Unit  Vector 

nn 

- 

N  Unit  Vector 

i 

- 

index 

Constants 

i 

None. 

Coupling 

t 

HAG 

Magnitude  of  a  vector 

CROSS 

Cross  product  of  two  vectors 

DOT 

Dot  product  of  two  vectors 

ADVEC3 

Add  three  vectors 

LNCOH2 

Multiply  two  vectors  by  two  constants 

LNCOH3 

Add  three  vectors  each  multiplied  by  a 

constant 

NORH 

Creates  a  Unit  Vector 

ANGLE 

Angle  between  two  vectors 

References 

s 

BMW 

pg.  109-116 

Bscobal 

pg.  306-307 

I 


*  C-24  * 


SUBROUTINE 
IMPLICIT 
RIAL* 8 
INTEGER 
EXTERNAL 


GIBBS  (  R1,R2,R3,  V2, Theta, fit  ) 

NONE 

R1(4),R2(4},R3(4),V2<4), Theta 

Pit 

DOT 


-  Local*  - 

REAL* 8  tov*r2,  1,  Small)  rlmr2,  r3mrl,  r2mr3,p(4),  q(4),  v(4), 
&  d(4),  n(4),  s<4),  b{4),  Dot,  PN(4),  RlN(4),dn(4),nn(4), 

t  Thetal 

INTEGER  1 

-  initialize  Variables  - 

Small=  0 . OOOOOIDO 
Pit  =  0 
Theta=  0.0D0 
CALL  MAG{  R1  ) 

CALL  MAG(  R2  ) 

CALL  MAG(  R3  ) 

DO  i‘~  1,4 

V2(l)=  O.ODO 
ENDDO 


*  Determine  It  the  vectors  are  coplanar.  The  DOT  product  of  R1  and  the 

*  normal  vector  of  R2  and  R3  will  be  0  if  all  three  vector*  are  coplanar. 

*  The  Vectors  are  normalised  to  accept  very  small  and  very  large 

*  vector*.  The  magnitudes  are  left  out  of  the  DOT  product  equation  t 

*  rln  dot  pn  =  rln  pn  Cos()  t  since  each  vector  Is  normalised,  so  the 

*  magnitudes  are  1.0.  A  1  deg  tolerance  Is  allowed  for  estimation,  and 

*  Is  implemented  by  allowing  the  angle  between  Rln  and  Pn  to  range  from 

*  89.0  to  91.0  deg,  or  Coa(89.0)  ■  0.017452406. 


CALL  CROSS!  R2,R3,P  ) 

CALL  CROSS!  R3,R1 ,Q  ) 

CALL  CROSS!  R1,R2,W  ) 

CALL  NORM(  P,FN  ) 

CALL  NORM(  Rl,  R1N  ) 

ir  (  DABS(  DOT(RlN,PN)  ) .GT.0.0174524D6D0  )  THEN 
Plt=  1 
ELSE 

CALL  ADVEC3(  P,Q,W,D  ) 

CALL  LNCOM3{  Rl<4) ,R2(4) ,R3(4) ,P,Q,W,N  ) 

CALL  NORM!  N,  NN  ) 

CALL  NORM!  D,  DN  ) 


*  Determine  If  the  orbit  Is  possible.  Both  D  and  N  must  be  In 

*  the  same  direction,  and  non-sero. 


IP  (  (  DABS(d( 4 ) ) . LB. Small  ).or.(  DA3S(n(4)).LE. SMALL  ) 
&  .or. (DOT(nn,dn) .LB.Small)  )  THEM 

Plt=  2 
ELSE 

CALL  ANGLE!  R1,R2,  Theta  ) 

CALL  ANGLE!  R2,R3,  Thetal  ) 

I?  (  Thetal. GT. Theta  )  THEN 
Theta  =  Thetal 
BNDIP 

-  Perform  Gibbs  method  to  find  V2  - 

Rlmr2=  Rl(4)-R2(4) 

R3mrl=  R3(4)-R1(4) 

R2mr3=  R2(4)-R3(4) 

CALL  LNCOH3(Rlmr2,R3arl,R2sir3,R3,R2,Rl,S) 

CALL  CROSS!  d,r2,b  ) 

L  =  1.0D0  /  D8QRT(d(4)*n(4) ) 

Tover2=  L/R2(4) 

CALL  LNCOM2(Tover2,L,B,S,V2) 

END  IP 
ENDIP 
RETURN 
END 


*  C-2S  * 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 
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* 
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* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


SUBROUTINE  HERRGIBBS 


This  Subroutine  implements  the  Herrlck-Glbbs  approximation  for  orbit 
determination,  and  finds  the  middle  velocity  vector  for  the  3  given 
position  vectors.  The  method  is  good  for  fast  calculations  and  small 
angles,  <=  10  deg.  Notice  the  angle  is  passed  back  since  vectors  which 
are  12  deg  apart  may  actually  be  accurate,  while  vectors  which  are  170  deg 
apart  would  not.  The  observations  MUST  be  sequential  and  taken  on  one 
revolution.  The  Use  of  Julian  Dates  for  input  makes  it  much  easier  to 
perform  calculations  where  the  sights  occur  around  midnight.  8everal 
flags  are  passed  back: 

Fit  =  0  ok 

Fit  s  i  orbits  not  coplanar 

Fit  =  2  angles  between  the  vectors  are  larger  than  10  deg 

Notice  a  1  deg  tolerance  is  allowed  for  the  coplanar  check.  This  is 
necessary  to  allow  for  noisy  data  in  the  estimation  project. 


Algorithm  s  Initialize  values  Including  the  answer 

Find  if  the  vectors  are  coplanar,  else  set  a  flag 
Find  the  largest  angle  between  the  vectors 
Calculate  the  Taylor  series  for  the  answer 

Author  i  Capt  Dave  Vallado  USAFA/DFA3  719-472-4109  28  Mar  1990 


Inputs 

Rl 

1 

IJK  Position  vector  #1 

R2 

- 

IJK  Position  vector  #2 

R3 

- 

IJK  Position  vector  #3 

JD1 

- 

Julian  Date  of  1st  sighting 

JD2 

- 

Julian  Date  of  2nd  sighting 

JD3 

- 

Julian  Date  of  3rd  sighting 

Outputs 

V2 

: 

IJK  Velocity  Vector  for  R2 

Theta 

- 

Angle  between  the  two  vectors 

Fit 

- 

Flag  Indicating  success 

DU 

DU 

DU 

days  from  4713  B.C. 
days  from  4713  B.C. 
days  from  4713  B.C. 


DU  /  TU 
rad 

0,  1,  2 


locals 

dt21 

dt31 

dt32 

TolAngle 

Thetal 

P 

pN 

IUN 

Terml 

Term2 

Term3 

1 


i 

-  time  delta  between  rl  and  r2  TU 

-  time  delta  between  r3  and  rl  TU 

-  time  delta  between  r3  and  r2  TU 

-  Tolerance  angle  (10  deg)  rad 


-  temporary  angle  between  the  two  vectorsrad 

-  P  vector  r2  x  r3 

-  P  Unit  Vector 

-  Rl  Unit  Vector 

-  First  Term  for  HClbbs  expansion 

-  Second  Term  for  HGlbbs  expansion 

-  Third  Term  for  HGlbbs  expansion 

-  Index 


Constants 

TUHin 


Hlnutes  In  each  Time  Unit 


13.44685108204 


Coupling 

HAG 

CROSS 

DOT 

NORM 

LNCOM3 

ANGLE 


Magnitude  of  a  vector 
Cross  product  of  two  vectors 
Dot  product  of  two  vectors 
Creates  a  Unit  Vector 

Combination  of  three  vectors  and  three  scalars 
Find  the  angle  between  two  vectors 


References 

Escobai 


pg.  254-256,  304-306 


( 


*  C-26  ♦ 


SUBROUTINE  HarrGlbbs  (  R1,R2,R3, JD1,JD2,JD3,  V2, Theta, Fit  ) 
IMPLICIT  NONE 

REAL* 8  R1(4),R2(4),R3(4) , JD1, JD2, JD3,V2(4) , That a 
INTEGER  Fit 
EXTERNAL  DOT 


-  Local*  - 

REAL* 8  dt21,  dt31,  dt32,  TolAngle,p(4) ,  Thatal, 
i  TUMin,  Dot,  PN(4),  R1N(4) ,  Terml,Term2,Term3 

INTEGER  i 


-  Initialize  Variables 

TUMin  =  13 . 44685108204DO 
Fit  =  0 

Theta  =  O.ODO 
CALL  HAG(  R1  ) 

CALL  MAG(  R2  ) 

CALL  MAG(  R3  ) 

DO  1=  1,4 

V2(l)=  O.ODO 
ENDDO 

TolAngle=  0.174S3292SD0 
DT21=  (JD2-JDl)*1440.0D0/TUMln 
DT31=  ( JD3-JDl)*1440.0D0/TUMin 
DT32=  ( JD3-JD2 ) *1440 . ODO/TUMln 


Da tormina  If  che  vector*  are  coplanar.  The  DOT  product  of  R1  and  the 
normal  vector  of  R2  and  R3  will  be  0  If  all  three  vectors  are  coplanar. 
The  Vector*  are  normalised  to  aocept  very  small  and  very  large 
vectors.  The  magnitude*  are  left  out  of  the  DOT  product  equation  i 
rln  dot  pn  =  rln  pn  Co*<)  s  since  each  vector  is  normalized,  so  the 
magnitudes  are  1.0.  A  1  deg  tolerance  is  allowed  for  estimation,  and 
is  Implemented  by  allowing  the  angle  between  Rln  and  Pn  to  range  from 
89.0  to  91.0  deg,  or  Cos(89.0)  *  0.017442406. 


CALL  CROSS (  R2,R3,P  ) 

CALL  N0RH(  P,PN  ) 

CALL  NORM(  Rl,  R1N  ) 

IF  (  DABS(  DOT(RIN.PM)  ) .OT.0.017452406D0  }  THEN 
Flt=  1 
ELSE 


Check  the  size  of  the  angles  between  the  three  position  vectors. 
Herrick  Gibbs  only  gives  "reasonable1*  answers  when  the 
position  vectors  are  reasonably  close.  10  deg  1*  only  an  estimate. 


CALL  ANGLE (  R1,R2,  Theta  ) 

CALL  ANGLE (  R2.R3,  Thatal  ) 

if  (  Thetal.GT. Theta  )  THEM 
Theta  *  Thetal 
END  IF 

IF  (  Theta. GT.TolAngle  )  THEN 
Flt  =  2 
ENDIF 

-  Perform  Herrlck-Glbbs  method  to  find  V2  - 

Tarral  =  -dt32*<  l.ODO/  (dt21*dt31)  +■  1.0D0/  (12*rl<4)**3)  ) 
Term2  =  (dt32-dt21)*<  1.0D0/  (dt21*dt32)  + 

&  1.0D0/  (I2*r2(4)«*3)  ) 

Terra3  =  dt21*(  1.0D0/  (dt32*dt31)  +  l.ODO/  (12*r3(4)**3)  > 
CALL  LNCOM3(  Terml,Ter*2,Tera3,Rl,R2,R3,  V2  ) 

ENDIF 

RETURN 

END 


*  C-27  * 


SUBROUTINE  PINDCandS 


* 

* 

* 

* 

* 

* 

* 

* 

* 

t 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  Subroutine  calculates  the  C  and  S  functions  for  use  in  the  Universal 
Variable  calculations.  NOTE  equality  is  handled  by  thn  series  expansion 
terms  to  eliminate  potential  discontinuities.  The  series  is  only  used  for 
negative  values  of  Z  since  the  truncation  results  in  rather  large  errors 
as  Z  gets  larger  than  about  10.0. 

Algorithm  i  If  Z  is  greater  than  aero,  use  the  exict  formulae  else 
use  the  series  form 

Author  :  Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  30  Jan  1991 

Inputs  : 

ZNew  -  z  variable 

Outputs  ! 

CNew  -  C  function  value 

SNew  -  S  function  value 

Locals  : 

ZSqrd  -  ZNew  squared 

ZFrth  -  ZNew  to  the  fourth  power 

SqrtZ  -  Square  root  of  ZNew 

Constants  : 

None. 

Coupling  : 

None. 

References  t 

BMW  pg.  207-210  (Complete  graph  of  3  and  C) 

Kaplan  pg.  304-305 


SUBROUTINE  FindCandS  (  ZNew,  CNew,SNew  ) 

IMPLICIT  NONE 

REAL* 8  ZNew, CNew, SNew 

-  Locals  - 

REAL* 8  SqrtZ,  ZSqrd,  ZFrth 

-  Implementation  - — — - - 

IF  (  ZNew.GT.O.ODO  )  THEN 
SqrtZ  =  SQRT(  Znew  ) 

CNew  =  (1.0DO-DC08(  SqrtZ  ))  /  ZNew 

SNew  =  (SqrtZ-DSIN(  SqrtZ  ))  /  (  SqrtZ**3  ) 

ELSE 

ZSqrd  =  ZNew**2 

ZFrth  =  ZSqrd**2 

CNew  5  0.5D0  -  ZNew/24.OD0  +  ZSqrd/720.0D0 
S  -  ( ZSqrd* ZNaw )/403 20. 0D0  +  ZFrth/3628800.0DO 

s  -  ( ZPr th*ZNew )/47 9001600. ODO 

SNew  =  1.0O0/6.0D0  -  ZNev/120.0D0  +  Z8qrd/5040.0DO 
S  -  ( ZSqrd* ZNew J/362 8 80, ODO  +  ZPrth/39916800.0D0 

s  -  ( ZPrth*ZNew)/6227020800 . ODO 

ENDIF 
RETURN 
END 


* 


*  C-28  * 


SUBROUTINE  NSWTONR 


This  Subroutine  performs  the  Newton  Rhapson  iteration  to  find  the 
Eccentric  Anomaly  given  the  Naan  anomaly.  The  True  Anomaly  Is  also 
calculated. 

Algorithm  i  Setup  the  first  guess 

Loop  while  the  answer  has  not  convergsd 

Write  an  error  if  the  answer  doesn't  converge 

Find  the  True  Anomaly  using  ATAN2  to  resolve  quadrants 


Author 

i  Capt  Dave  Vallado  UBAFA/DFAS 

719-472-4109  12  Aug  1988 

Inputs 

< 

e 

-  Eccentricity 

0.0  -  1.0 

M 

-  Mean  Anomaly 

0.0  -  2Pi  rad 

Outputs 

t 

0.0  -  2P1  rad 

E0 

-  Eccentric  Anomaly 

Nu 

-  True  Anomaly 

0.0  -  2Pl  rad 

Locals 

i 

El 

-  Eccentric  Anostfly,  nest  value 

rad 

Slnv 

-  Sine  of  Nu 

Cosv 

-  Cosine  of  Nu 

1 

-  Index 

Constants 

None. 

t 

Coupling 

None. 

i 

References 

i 

3HW 

pg.  184-186,  220-2*2 

SUBROUTINE  NevtonR  (  E,H,  >0,NU  ) 
IMPLICIT  NONE 
REAL* 8  B,M,SQ,Nu 
INTEGER  1 


-  locals  - 

REAL+8  Slnv,  Cosv,  El 

-  Initialise  Variables 

EO*  M 
1=  1 


-  Newton  Iteration  for  Eccentric  Anomaly  - 

El*  SO  -  (  (  20  -  e*D8IN(E0)-m  )  /  (  1.0  -  e«DCO8{E0)  )  ) 

DO  WHILE  (  (DABS(Bl-SO) .GT.O.OOOOOOIDO) .and. ( l.le. 20)  ) 

R0=  El 

El=  E0  -  (  (  E0  -  e*DSIN(E0)-m  )  /  (  l.ODO  -  e*DCOS(EO)  )  ) 
1  =  1  +  1 
KNDDO 

IF  (  l.gt.20  )  THEN 

WRITE (*,*)  'Newton  Rhapson  not  converged  in  20  Iterations' 
ENDIF 


-  True  Anomaly  at  Epoch  - 

81nv=  (  DSQRT {  1.0D0-e*e  )  *  DSIN(El)  )  /  (  1.0D0-e‘DCOS(Bl)  ) 
Cosv=  (  DCOS(El)-e  )  /  {  l.ODO  -  e*DCOS(Bl )  ) 

NU  =  DATAN2(  Slnv.Cosv  ) 

RETURN 

END 


*  C  29  • 


SUBROUTINE  KEPLER 


This  Subroutine  solves  Keplers  problem  for  orbit  determination  and  returns  a 
future  Geocentric  Equatorial  (IJK)  position  and  velocity  vector.  The 
solution  Subroutine  uses  Universal  variables. 


Algorithm 


Inputs 

Ro 

Vo 

Time 

Outputs 

R 

V 

Locals 

F 

G 

FDot 

GDot 

XOld 

XOldSqrd 

XNev 

XNevSqrd 

ZNsw 

CNew 

SNew 

DeltaT 

TimaNev 

RDotV 

A 

Alpha 

SHE 

Period 

S 

W 

Temp 

Small 

l 

Constants 
Half Pi 
TwoPl 
Infinite 

Coupling 

HAG 

DOT 

COT 

PlndCandS 

References 

Kaplan 

BMW 


t  Initialize  variables 

Find  size  and  shape  paraswters  for  all  cases 
Setup  Initial  guesses  with  IF  statements 
Loop  while  the  tine  has  not  converged 
If  too  many  Iterations,  print  an  error 
otherwise  calculate  the  answer 
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DU 

DU  /  TU 
TU 


DU 

DU  /  TU 


-  IJK  Position  vector  -  initial 

-  IJK  Velocity  vector  -  initial 

-  Length  of  time  to  propagate 

t 

-  IJK  Position  vector 

-  IJK  Velocity  vector 


f  expression 

g  expression 

f  dot  expression 

g  dot  expression 

Cld  Universal  Variable  X 

XOld  squared 

New  Universal  Variable  X 

XNaw  squared 

New  value  of  z 

C(x)  function 

S(s)  function 

change  in  t 

Maw  tiiA 

Result  of  P.o  dot  Vo 

Seal  aajor  axis 

Reclprocol  1/a 

Specific  Hech  Energy 

Time  period  for  satellite  TU 

Variable  for  parabolic  case 

Variable  for  parabolic  case 

Temporary  real  value 

Tolerance  for  roundoff  errors 

index 


-  Flag  for  an  Infinite  element 


Magnitude  of  a  vector 
Dot  product  of  two  vectors 
Cotangent  function 
Find  C  and  S  functions 


pi.  3C4-308  (  Includes  first  guess  for  a  It  parabolic) 

pg.  191-199,  203-212 


DU2  /  TU2 


1.57079632679490 
6 . 2B318530717959 
999999.9 


*  C-30  * 


SUBROUTINE  Kepler  (  Ro, Vo, Time,  R,V  ) 
IMPLICIT  NONE 

REAL* 8  Ro(4),Vo(4),Time,R(4),V(4) 
EXTERNAL  DOT,  COT 


-  Locals  - 

REAL*8  F,  G,  FDot,  GDot,  DeltaT,  X01d,X01dSqrd,XNev,XNevSqrd, 
t  ZNev,  CNaw,  SNew,TlmeNew,RDotV,A,Alpha, 

&  SHE, Period, S,W,Teap,  Snail, TwoPl,HalfPl, Dot,  Cot, Infinite 

INTEGER  1 


-  Initialize  Variables 

Half Pi  =  1 . 57079632679490D0 
TvoPi  =  6. 2 8 31 8 5307179 59D0 
Infinite=  999999.9 
Small  =  O.OOOOOIDO 
TlmeNev  =  -10.0DO 
CALL  HAG(  Ro  ) 

CALL  MAG(  Vo  ) 

RDotV=  DOT(  Ro,Vo  ) 

DO  1=  1,4 

V(l)  =  0.0D0 
ENDDO 


-  Find  SHE,  Alpha,  and  A  — 

SME=  (  Vo(4)**2  /  2.OD0  )  -  <  1.0D0/Ro(4)  ) 
Alpha=  -SKE*2.0D0 
IF  (DABS{  SMB  ).GT. Small)  THEN 
A=  -1.0D0  /  (  2.0D0*8M*  ) 

ELSE 

A=  Infinite 
ENDIF 

IP  (DABS(  Alpha  ).LT. Small)  THEN 
Alpha=  0.0D0 
ENDIF 


* 


* 


* 


* 


* 


i 


i 

t 


-  Setup  initial  guess  for  x  - 

-  Circle  and  Ellipse  - 

IF  (Alpha. GS. Small)  THEN 

Perlod=  TwoPi  *  DS0RT(  DAB8<A)**3  ) 

IF  (DABS(  Tima  ).GT.AB8(  Period  ))  THEN 
Tinea  DMOD(  Tine, Period  ) 

ENDIF 

IF  (DABS(Alpha-l.ODO).GT. Snail)  THEN 
XOld  a  Tine  *  Alpha 
ELSE 

Hake  sure  1st  guess  isn't  too  close  for  a  circle,  r=a  - 

XOlda  T lme*Alpha*0 . 97DO 
ENDIF 


BL8B 


-  Parabola  - 

IF  (DABS(  Alpha  ).LT. Snail)  THEN 
sa  0.5D0  *  (Halfpl  -  DATAN( 

3 .0D0*DSQRT(  1.0D0/(Ro(4)**3)  )*  Tine  )  ) 

Wa  DATAN(  DTAN(  8  )**( 1 . ODO/3 . 0D0  )  ) 

XOld  =  DSQRT(Ro(4) )*(  2. ODO*COT( 2 .0D0*H)  ) 

Alpha =  O.ODO 
BLSE 

-  Hyperbola  - 

Tampa  -2.0D0*Tl»e  / 

(  A*(  RDotV  +  SIGN(1.0D0,Time)* 
DSQRT(-A)*(1.0D0-Ro(4)/a)  )  ) 

XOlda  SIGN(  1.0D0,Tlne  )  *  DSQRT (  -A  )  *  DLOG(  Temp  ) 
ENDIF 
ENDIF 


* 


*  C-31  * 


i=  1 

DO  WHILE  (  (DABS(TlneNew-Time) . GT.0.000001D0)  .and.  ( i .LE.15)  ) 
X01dSqrd=  X01d**2 
ZNew  =  XOIdSqrd  *  Alpha 

- Find  C  and  S  function* - 

CALL  FindCandS(  ZNew,CNew,SNev  ) 

-  Use  a  Newton  iteration  for  new  values  - 

TimeNr'w  =  X01dSqrd*X01d*SNew  +  RDotV*X01dSqrd*CNew  + 

&  Ro(4)*X01d*(  1.000  -  ZNew*SNew  ) 

DeltaT  =  X01dSqrd*CNew  +  RDotV*X01d*(  1.0D0  -  ZNew*SNew  )+ 

&  Ro(4)*(  1.000  -  ZNew*CN*W  ) 

-  Calculate  new  value  for  x  - 

XNew  »  XOld  +  (  Tiae-TlmeNev  )  /  DeltaT 


Check  if  the  orbit  is  an  ellipse  and  xnew.CT.2pi  SQRT(a),  the  step 
size  must  be  changed.  This  is  accomplished  by  multiplying  DeltaT 
by  10.0.  NOTR  i 1  10.0  is  arbitrary,  but  seems  to  produce  good 
results.  The  idea  is  to  keep  XNew  from  increasing  too  rapidlly. 


IF  (  (A.GT.O.ODO  )  .and. (  ABS(XNew) .GT.TwoPl*DSQRT(A) ) .and. 
t  (SKR.LT.O.ODO)  )  THEN 

XNew  3  XOld  +  (  Tlste-TioeNaw  )  /  (  DeltaT*10.0D0  ) 
ENDIP 

Wrlte(  *,60  )  1, XOld, TIsmNsw, DeltaT, XNew, SHew,CNew, anew 
60  FORMAT (  12, IX, 7 (F10 .5)  ) 


1=  1  +  1 
XOld  -  XNew 

EHDDO 

IF  (  1.GT.15  )  THEN 

Write  (*,*)  ‘Kepler  not  converged  in  15  iterations  ‘ 

ELSE 

Calculate  position  and  velocity  vector*  at  new  time  - 

XNevSqrd  =  XNew* *2 

F  3  1.0D0  -  (  XNewSqrd*CNew  /  Ro(4)  ) 

G  =  Time  -  XNew8qrd*XNew*8New 
DO  1=  1,3 

R(l)=  P»Ro( 1 )  +  G*Vo( 1 ) 

ENDDO 

CALL  MAG(  R  ) 

GDot  =  1.0DO  -  (  XNewSqrd*CNew  /  R(4)  ) 

PDot  =  (  XNew  /  (  Ro(4)*R(4)  )  )  »  (  ZNew*8New  -  1.0D0  ) 
DO  1=  1,3 

V(l)=  FD0t*R0{ 1 >  +  GDot*Vo(l) 

ENDDO 

CALL  MAG(  V  ) 

ENDIP 


RETURN 

END 


* 

* 

* 


SUBROUTINE  GAUSS 


*  This  Subrout  in*  solves  the  G«ua«  problem  of  orbit  determination  and  return* 

*  the  velocity  vectors  at  each  of  two  given  position  vectors.  The  solution 

*  uses  Universal  Variables  for  calculation  and  a  blssection  technique  for 

*  updating  Z.  This  method  is  slower  than  the  Newton  iteration  discussed  in 

*  BMW,  but  it  does  NOT  suffer  problems  with  negative  a  values,  and  is  valid 

*  for  ellipses  LESS  THAN  one  revolution,  parabolas,  and  Hyperbolas.  Also 

*  note  the  selection  of  small  since  the  algorithm  is  very  sensitive  to 

*  changes  in  this  variable.  A  value  of  0.001  will  converge  in  say  10 

*  Iterations  Instead  of  25  iterations  with  0.000001,  and  the  accuracy  will 

*  differ  in  the  3rd-4th  decimal  place.  I  chose  to  keep  the  higher  accuracy 

*  for  cases  like  example  13,  BMW  pg.  274,  *5.10. 

*  (  Refer  to  graph  on  BMW  pg.  235  for  ranges  of  s.  ) 

* 


* 

Algorithm 

1 

Initialise  variable*  and  setup 

initial  guesses 

* 

Loop  while  the  time  has  not  converged 

* 

If  too  many  Iterations,  print  an  error 

* 

* 

otherwise  calculate  the  answer 

* 

Author 

l 

Capt  Dave  Vallado  U8AFA/DPAS 

719-472-4109  20  Sep  1990 

Inputs 

l 

R1 

- 

IJK  Position  vector  1 

DU 

R2 

- 

UK  Position  vector  2 

DU 

DM 

- 

direction  of  nation 

'L' , '8' 

Time 

Time  between  R1  and  R2 

TU 

Outputs 

: 

VI 

- 

UK  Velocity  vector 

DU  /  TU 

V2 

- 

IJK  velocity  vector 

DU  /  TU 

Locals 

t 

VarA 

- 

Variable  of  the  iteration,  NOT 

the  semi  major  axlsl 

Y 

- 

Upper 

- 

Upper  bound  for  Z 

Lower 

- 

Lower  bound  for  Z 

CosDeltaNu 

- 

Cosine  of  true  anomaly  change 

rad 

P 

- 

f  expression 

G 

- 

g  expression 

GDot 

- 

g  dot  expression 

XOld 

- 

Old  universal  Variable  X 

XOldCubed 

- 

XOld  cubed 

ZOld 

- 

New  value  of  s 

zn«w 

- 

New  value  of  s 

CNaw 

- 

C ( z )  function 

SNew 

- 

S(z)  function 

TlmeNev 

- 

New  time 

TU 

Small 

- 

Tolerance  for  roundoff  errors 

1 

- 

index 

j 

- 

index 

Constants 

s 

TwoPl 

6.28318530717959 

Coupling 

: 

HAG 

Magnitude  of  a  vector 

DOT 

Dot  product  of  two  vectors 

FindCandS 

Find  C  and  S  functions 

References 

i 

BMW 

pg.  228-241  (Uses  a  Newton  Iteration) 

* 


*  C  13  * 


SUBROUTINE  GAUSS  (  Rl,R2,DM,Tlsie,  VI, V2  ) 
IMPLICIT  NONE 

REAL* 8  Rl(4),R2(4),Tlffl*,Vl(4),V2(4) 
CHARACTER  DM 
EXTERNAL  DOT 


-  Local*  - 

REAL* 8  VarA,  2,  Upper,  Lower,  CosDeltaNu,  P,  G,  GDot, 

&  XOld,  X01dCubed,Z01d,  ZHew,  CNew,  3H»w,  TimaNew, 

&  Snail, TwoPi,  Dot 

INTEGER  i,  j 


-  initialize  Variables  - 

TwoPl  =  6 .28318530717959DO 
Small  =  O.OOOOOIDO 
TimaNew-  -10.0DO 
CALL  MAG(  R1  ) 

CALL  MAG(  R2  ) 

DO  1=  1,4 

Vl(i)=  'DO 
V2( 1)=  O.ODO 
BNDDO 

CosD«ltaNu=  DCT(R1,R2)/(R1(4)*R2(4) ) 

IF  (Da.EQ.'L')  THIN 

VarA  =  -DSflRT(  Rl(4)*R2(4)*(1.0D0+CosDeltaNu)  ) 
ELSE 

VarA  =  D8QRT(  R1(4)*R2(4)*( l.ODQ+CosDeltaNu)  ) 
ENDIF 


-  Form  Initial  guesses  - 

Z01d=  O.ODO 
CNaw  =  0.5D0 
SNew  =  1.0D0/6.0DO 

-  Bounds  for  Z  iteration  - 

Upper=  TwoPl**2 
Low»r=  “2.0D0*TwoPi 

-  Determine  if  the  orbit  is  possible  at  all 

IF  (DABS{  VarA  ) .GT. Small)  THIN 


Perforin  Gaussian  Iteration  using  Universal  Variables.  Notice 
the  Iteration  is  performed  using  a  bisaectlon  technique  instead  of 
a  Newton  itertlon.  Although  the  Newton  Iteration  is  quicker,  the 
bisaectlon  will  not  fail  with  large  negative  Z  values.  The  upper 
and  lower  bounds  are  adjusted  a*  required  to  keep  y  from  becoming  -. 


*  <•  14  » 


i=  0 

DO  VmiLB  (  (DABS(TlmeNew-Time)  .GT. Small)  .and.  (i.LB.30)  ) 
Y=  Rl(4)+R2(4)-(  VarA* ( 1 . 0D0-ZOld*SNew ) /DSQRT ( CNew )  ) 


*  A  check  is  needed  for  special  cases  where  VarA  it  greater  than  0.0. 

*  It's  possible  that  2  can  becoae  very  negative,  and  cause  the  square 

*  root  in  the  XOld  calculation  to  blow  up.  This  section  loops  until 

*  the  ZNew  value  will  result  in  a  +  y  value.  The  solution  is  to  slowly 

*  update  the  lower  bound  of  Z  until  y  is  +.  The  0.8*  for  ZNew  is  simply 

*  a  means  to  let  Z  change  a  little  slower.  The  ZNew  equation  is  found 

*  by  solving  the  y  equation  for  *  whan  y  =  0. 


IF  ((  VarA.GT.O.ODO  ).and.(  Y.LT.0.0D0  ))  THEN 

j=  1 

DO  WHILE  (  (  T.LT.0.0D0  ).and.(  j.LT.10  )  ) 

ZNew*  0 . 8D0* ( 1 . ODO/SHew ) * (  l.ODO  - 
&  (  Rl(4)+R2(4) )*D8QRT(CNew)/VarA  ) 

-  rind  C  and  S  functions  - 

CALL  ?lndCand8(  ZNew,  CNew,6New  ) 

Z0ld=  ZNew 
Lowers  zoid 
Y=  Rl(4)  *  R2(4)  - 

(  VarA* ( 1 . 0D0-ZOld*SN#W ) /DSQRT (CNew)  ) 

j  »  1  +  1 

END  DO 

IF  (j.GS.10)  THEN 

WRITE( * , * )  'Iteration  failed  for  In  in  Gauss' 
END  IF 
ENDIF 

X01d=  DSQRT (  Y/CNew  ) 

XOldCubed*  X01d**3 

TimeNew  =  X01dCubed*8New  +  VarA*DSQRT(Y) 

-  Readjust  upper  and  lower  bounds  - 

IF  (TimeNew. LT. Time}  THAN 
Lowers  ZOld 
KNDIF 

IF  (TlmeNew.GT.TlM)  THEN 
Uppers  ZOld 
KNDIF 

ZNew=  (  Upper+Lower  )  /  2.0D0 

Wrlte(  *,60  )  1, ZOld, Y, XOld, TiMNew, VarA, upper, lower 

*  60  FORMAT (  I2,1X,7(W0.5)  ) 

* 

*  -  Hake  sure  the  first  gueso  isn't  too  close  - 

IF  ((DABS(TlMNew-TlM).LT. Small). and. (1. IQ. 0))  THIN 
TimeNew  ■  -10.0D0 
ENDIF 


* 


& 


-  Find  C  and  8  functions  - 

call  FlndCandS(  ZNew,  CHev,SNev  ) 

ZOld  =  ZNew 
1=  i  +  1 

END  DO 

IF  (  i.GE.30  )  THEN 

Write  (*,*)  'Gauss  not  converged  in  30  iterations  ' 

ELSE 

-  U3e  ?  and  G  series  to  find  Velocity  Vectors  - 

F  =  i.odo  -  (  I  /  Rl(4)  ) 

G  =  VarA*D8QRT(  I  ) 

GDot  =  l.ODO  -  Y/R2(4) 

DO  1=  1,3 

Vl(l)=  (  R2(i)  -  F*Rl(i)  )/G 
V2( l)=  (  GDot*R2(l)  -  R1 ( i )  )/G 
BHD  DO 

CALL  HAG(  VI  ) 

CALL  HAG(  V2  ) 

ENDIF 

ELSE 

Wrlte(  *,*  )  'Gauss  problem  cannot  be  solved' 

ENDIF 

RETURN 

END 


*  C-35  » 


SUBROUTINE  IJKtOLATLON 


* 

* 

* 

* 

♦ 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

t 

* 

♦ 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  Subroutine  converts  a  Geocentric  Equatorial  (IJK)  position  vector  Into 
latitude  and  longitude.  Geodetic  and  Geocentric  latitude  are  found. 


Algorithm 


Author 


Initialize  variables 

Find  the  longitude  being  careful  to  reslove  the  angle 

Setup  iteration  for  latitude 

Loop  while  the  deltas  are  not  equal 

Write  an  error  message  if  the  values  do  not  converge 

Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


Inputs  i 

R  -  ijx  position  vector 

JO  -  Julian  Date 


DU 

days  from  4713  B.C. 


Outputs  i 

GeoCnLat  -  Geocentric  Latitude 

Lon  -  Longitude  (WEST  -) 


-Pi/2  to  Pl/2  rad 
-2P1  to  2Pi  rad 


Locals  t 

Rc 

Height 

Alpha 

OldDelta 

DeltaLat 

GeoDtLat 

TvoFMinusF2  - 

OneMlnusF2  - 

Delta 

RSqrd 

Temp 

GST 

SlnTemp 

i 


Range  of  site  v.r.t.  earth  center 
Height  above  earth  w.r.t.  site 
Angle  frost  I  axis  to  point,  L8T 
Previous  value  of  DeltaLat 
Dlff  between  Delta  and  Geocentric  lat 
Geodetic  Latitude 
2*F  -  F  squared 
(  1  -  F  )  squared 

Declination  angle  of  R  in  IJK  system 
Magnitude  squared 

Dlff  between  Geocentric/Geodetic  lat 
Greenwich  Sidereal  Tine 
Bine  of  Teep 
index 


DU 

DU 

rad 

rad 

rad 

rad 


rad 

DU2 

rad 

rad 

rad 


Constants  i 

Pi 

TwoPl 

Flat  -  Platennlng  of  the  Earth 


3.14159265358979 

6.28318530717959 

0.003352810664747352 


Coupling 
MAG 
GST 1 me 


Magnitude  of  a  vector 
Greenwich  Sidereal  Tine 


References 

Escobal 


pg.  398-399 


*  C-36  * 


SUBROUTINE  IJKtoLatLon  (  R,  JD,  GeoCnLat,  Lon  ) 
IMPLICIT  NONE 

REAL*8  R(4) ,JD, GeoCnLat, Lon 
EXTERNAL  GSTlme 


-  Local*  - 

REAL *8  Rc,  Haight,  Alpha,  OldDalta,  DaltaLat,  GaoDtLat, 
&  TwoFHlnusF2,OneHlnu»F2,  Dalta,  Tamp,  GST,  R8qrd, 

t  Pl,TvoPl,Flat,  GSTima,  SinTamp 

INTEGER  i 


-  Initialise  value* 

PI  =  3. 14159 2653 58979D0 
TwoPi  =  6 . 28318530717959DO 
Flat  =  0, 00335 28106647 47352D0 
TwoFMlnu*F2  =  2.0D0*Flat  -  Flat**2 
On*MlnusF2  =  (  l.ODO-Flat  )**2 
CALL  MAG(  R  ) 


-  Find  Longitude  value  - 

Temp  =  DSQRT (  R(1)*R{1)  +  R(2)*R(2)  ) 

Alpha  a  DATan2{  R(2)  /  Temp  ,  R(i)  /  Temp  ) 

GST  =  GST1HE(  JD  ) 

Lon  =  Alpha  -  GST 
IF  (  DABS(Lon) .GE.P1  )  THEN 
IF  (  Lon. LT. 0.0  )  THEN 
Lon  =  TwoPi  +  Lon 
ELSE 

Lon  =  Lon  -  TwoPi 
END  IF 
BNDIF 

-  Set  up  Initial  latitude  value  - 

Delta  *  DATan (  R(3)  /  Tamp  ) 

IF  (  DABS (Delta ) .GT. Pi  )  THEN 
Delta  =  dhod(  Delta, Pi  ) 

END  IF 

GeoCnLat  *  Dalta 
OldDalta  =  1.0D0 

DaltaLat  =  10.0D0 
RSqrd  =  R{4)**2 

-  Iterate  to  find  Geocentric  and  Geodetic  Latitude  — 

1  «  1 

DO  WHILE  (  (  DABS(OldDelta-DeltaLat) .GT.0.00001DO) .*nd. 

&  ( 1 .LT. 10)  ) 

OldDelta  *  DaltaLat 

Rc  =  DSQRT (  (  1.0D0-TwoFMlnu»F2  )  / 

t  (  1 . 0D0-TvoFMlnuiF2*DCOS ( GeoCnLat ) **2  )  ) 

GaoDtLat  =  DATan (  DTAN(GeoCnLat)  /  OneMlnu*F2  ) 

Temp  =  GaoDtLat-GeoCnLat 

81nT#mp  =  DS IN (Temp) 

Height  =  DSQRT (  RSqrd  -  Rc**2*SlnTemp**2  )  - 

t  Ro*DCOS(T*mp) 

DaltaLat  =  DA8IN(  Height*SinTemp  /  R(4)  ) 

GeoCnLat  =  Delta  -  DaltaLat 
1  =  1  +  1 
KNDDO 

IF  (  1.GE.10  )  THEN 

Wrlte(*,*)  'IJKtoLatLon  did  NOT  converge  1 
BNDIF 
RETURN 
END 


*  C-37  * 


* 

* 


SUBROUTINE  SUN 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  Subroutine  calculates  the  Geocentric  Equatorial  position  vector  for 
the  Sun  given  the  Julian  Date.  This  is  the  low  precision  formula  and 
is  valid  for  years  frosi  19S0  to  2050.  Accuaracy  of  apparent  coordinates 
is  0.01  degrees.  Notice  many  of  the  calculations  are  performed  in 
degrees,  and  are  not  changed  until  later.  This  is  due  to  the  fact  that 
the  Almanac  uses  degrees  exclusively  in  their  formulations. 


Algorithm 


Author 

Inputs 

JD 

Outputs 

RSun 

RtAsc 

Decl 


«  Calculate  the  several  values  needed  to  find  the  vector 
Be  careful  of  quadrant  checks 

i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  25  Aug  1988 


-  Julian  Date 

days  from  4713  B.C. 

i 

-  IJX  Position  vector  of  the  8un 

At) 

-  Right  Ascension 

rad 

-  Declination 

rad 

Locals  t 

MeanLong  -  Mean  Longitude 

MeanAnomaly  -  Mean  anomaly 

N  -  Number  of  days  from  1  Jan  2000 

EclpLong  -  Ecliptic  longitude 

Obliquity  -  Mean  Obliquity  of  the  Ecliptic 


Constants  i 
Pi 

TwoPi 

Rad 


Coupling  < 

None. 


3.14159265358979 

6.28318530717959 

57.29577951308230 


References  i 

1907  Astronomical  Almanac  Pg.  C24 


*  C-38  * 


SUBROUTINE  Sun  (  JD,  R8un,RtA*c,Dacl  ) 
IMPLICIT  NONE 

RIAL*8  JD,HSun ( 4 ) , RtAsc, Dacl 


*  -  Local*  - 

REAL* 8  HaanLong,  HaanAnooaly,  EclpLong,  Obliquity,  N,  Pi, 
i  TvoPi,  Rad 


*  -  Xnltlalli*  value* 

PI  *  3.H159265358979D0 
TwoPl=  6.28318S307179S9DO 
Rad  =  57 . 29577951308230D0 
N  =  (  JD  -  2451545. 0D0  ) 


MaanLong=  280.460DO  +  0.9856474D0*N 
HeanLong-  DMOD{  M*anLong,360.0D0  ) 

MaanAnoaaly=  357.528D0  4-  Q.9856003D0*N 
HaanAnoMly-  DNOD(  H*anAnoataly/Rad,TvoPl  ) 

IP  (NaanAnoaialy.LT.O.ODO)  THIN 

MeanAnomaly=  TwoPl  +  HaanAnooaly 
BNDZF 

EclpLong  =  HaanLong  +  l,915D0*DSIN(HaanAno«aly)  + 

&  0.020D0*DSIN(2.0D0*HaanAno»aly) 

Obllqulty=  23.439D0  -  0.0000004DO*N 

HaanLong  =  MeanLong/Rad 
IP  ( HaanLong. LT.O.ODO)  THIN 
H*anLong=  TwoPl  4-  HaanLong 
ENDIP 

EclpLong  =  EclpLong  /  Rad 
Obliquity  =  Obliquity  /  Rad 

RtAsc3  DAT AN (  DCOS (Obliquity) *DTAN ( EclpLong )  ) 

*  -  Chack  that  RtAsc  la  In  th*  saoa  quadrant  as  EclpLong  - 

*  - maka  sura  It's  In  0  to  2pl  rang*  - 

IP  (EclpLong. LT.O.ODO)  THIN 
EclpLong3  EclpLong  4-  TwoPl 
ENDIP 

IF  (DABS(EclpLong-RtAao) .GT. (P1/2.0D0) )  THIN 

RtA*c=  RtAsc  +  0 . 5D0*Pl*DNINT( (IclpLong-RtAic )/( 0 . 5D0*P1 ) ) 
ENDIP 

Decl  -  das IN (  DSIN(0bllqulty)*D8IN(lclpLong)  ) 

*  -  find  magnitude  of  SUN  vector,  than  coaponant*  - 

RSun(4)=  1.00014DO  -  0.01671D0*DCO8(  HaanAnooaly  ) 
i  -  0.00014D0*DCOS(  2 . ODO*HaanAnoo*ly  ) 

RSun(l)3  RSun(4)‘DC03(  EclpLong  ) 

RSun(2)=  R8un(4)*DC08(0bllqulty)*D8IN(BclpLong) 

RSun(3)>  RSun( 4 )*DSIN(Obllqulty)*D8IN( EclpLong) 

RETURN 

END 


*  C-39  * 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

★ 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

A 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

★ 

* 

* 
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SUBROUTINE  MOON 

This  subroutine  calculates  the  Geocentric  Equatorial  (IJK)  position  vector 
for  the  moon  given  the  Julian  Date.  This  is  the  low  precision  formula  and 
is  valid  for  years  between  1950  and  2050.  Notice  many  of  the  calculations 
are  porformed  in  degrees.  This  coincides  with  the  development  in  the 
Almanac.  The  equation  for  Ecliptic  Longitude  was  split  in  two  to  prevent 
software  problems  with  numeric  coprocessors.  The  error  seemed  to  be  a 
stack  overflow  since  the  equation  is  so  long.  The  program  errors  are  as 
follows* 

Bclpitic  Longitude  0.3  degrees 

Bclpitic  Latitude  0.2  degrees 

Horiz  Parallax  0.003  degrees 

Distance  from  Barth  0.2  DUs 

Right  Ascension  0.3  degrees 

Declination  0.2  degrees 

Algorithm  *  Find  the  initial  quantities 
Calculate  direction  cosines 
Find  the  position  and  velocity  vector 


Author 

t  Capt  Dav.  Vallado  USAFA/DFA8  719- 

-472-4109  25  Aug  1988 

Inputs 

i 

JD 

-  Julian  Date 

days  from  4713  B.C, 

Outputs 

i 

RHoon 

-  IJK  Position  vector  of  th.  Moon 

DU 

RtAsc 

-  Right  Ascension 

rad 

Decl 

-  Declination 

rad 

Locals 

t 

EclpLong 

-  Ecliptic  Longitude 

EclpLat 

-  Bclpitic  Latitude 

HzParal 

-  Horizontal  Parallax 

I 

-  Gaocentric  Direction  Cosines 

m 

-  II  • 

n 

»  W 

Tu 

-  Julian  Centuries  from  1  Jan  1900 

X 

-  Temporary  REAL  value 

Constants 

* 

TwoPl 

6.28318530717959 

Rad 

57.29577951308230 

Coupling 

* 

Nona. 

References 

: 

1987  Astronomical  Almanac  Pg.  D46 

Explanatory  Supplement  1960  )  pg.  106-111 

Roy,  Orbital  Motion  Pg.  61-62  (  Discussion  of  parallaxes  ) 


*  0-40  * 


SUBROUTINE  Moon  (  JD , RMoon , Rt  A*c ,  Dtcl  ) 

IMPLICIT  NONE 

REAL* 8  JD,RMoon(4),RtAsc,Dacl 

-  Local*  - 

REAL* 8  EclpLong,  EclpLat,  HiParal,  l,n,n,Tu, TwoPl,  Rad,  x 

-  Inltlallaa  valuta  - 

TvoPl=  6.28318530717959D0 
Rad  =  57  >2957795130823000 
Tu  =  (  JD  -  2451545.000  )  /  36525.000 

x  =  218.32D0  *  481267. 883D0*Tu 

&  *  6.29*DSln(  (134. 900+477198. 85D0*Tu)/Rad  ) 

t  -  1.27*DSin(  (259. 200-413335. 38D0*Tu)/Rad  ) 

t  +  0.66*DSln(  (235. 700+890534. 23D0*Tu)/Rad  ) 

EclpLong=  x  +  0.21D0*DSln(  (269.9D0+954397.70D0*Tu)/Rad  ) 

t  -  0.19D0*DSln(  (357.5D0+  35999. 05D0*Tu)/Rad  ) 

t  -  O.UDO*D81n(  (186.6DO+966404.05DO*Tu)/Rad  ) 

EclpLat  =  S.13D0*DSln(  (  93.3DO+483202.O3D0*Tu)/Rad  ) 
t  *  0.28D0*DSln(  (228. 2D0+960400. 87D0*Tu)/Rad  ) 

t  -  0.28D0*DSln(  (318.3D0+  6003.18D0*Tu)/Rad  ) 

t  -  0.17D0*DSln(  ( 217. 6D0-407332. 2000 *Tu)/Rad  ) 

x  =  0.9508D0  ♦ 

t  0.0518D0*OCoa(  (134. 9+477198. 85*Tu)/Rad  ) 

HiParal  =  x  +  0.0095D0*DCo*(  (259. 200-413335. 38D0*Tu)/Rad  ) 

(  *  0.0078D0*DCo»(  (235. 7D0+890534. 23D0»TU)/Rad  ) 

(  +  0.0028D0*DCoa(  (269. 900+954397. 70DO*Tu)/Rad  ) 

EclpLong  -  DM0D(  EclpLong/Rad,  TwoPl  ) 

EclpLat  =  DMOD(  sclpLat/Rad,  TwoPl  ) 

HzParal  *  DH0D(  HzParal/Rad,  TwoPl  ) 

-  Plnd  tht  gaocantrlc  dlractlon  coalnta  - 

1*  DC0S(  EclpLat  )  *  DC0S(  EclpLong  ) 
m=  0 . 917  5D0*DCO8( EclpLat ) *D8IN( EclpLong ) 
t  -  0.3978D0*D8IM( EclpLat) 

n*  0 . 397800*0008 ( EclpLat )*08IM( EclpLong ) 

6  +  0. 9175C9*D8IN( EclpLat ) 

-  Calculata  Moon  position  vactor  — - - 

RMoon(4)=  1.0D0/D8IN(  HiParal  ) 

RMoon ( 1 ) =  RMoon(4)*l 
KMoon(2)»  RKoon(4)*n 
RMoon(3)=  RMoon(4)*n 

-  Plnd  Rt  Aa can i Ion  and  Dtcllnatlon  - 

RtA*c=  DATan2(  m,l  ) 

Oacl  *  DAG IN (  n  ) 


RETURN 


* 

* 


SUBROUTINE  PLAN1TRV 


* 

*  This  subroutine  calculates  th*  planetary  ephemerides  using  the  Epoch  J2000. 

*  The  coefficients  are  obtained  from  Danbys  book  and  provision*  are  left 

*  to  obtain  Heliocentric  Equatorial,  or  Heliocentric  Ecliptic  coordinates. 

*  Notice  the  epheaeris  presents  data  wrt  the  solar  equator. 

* 

*  Algorithm  i  Use  a  case  statement  to  assign  each  planets  values 

*  Find  the  vectors 

*  Author  t  Capt  Dave  Vallado  U8AFA/DFA8  719-472-4109  19  Dec  1989 


Inputs 

1 

NumPlanet 

-  Number  of  planet 

lead 

JD 

-  Julian  Date 

days  from  4713  B.C. 

Outputs 

R 

-  XYZ  position  vector 

AU 

V 

-  XYZ  velocity  vector 

AU  /  TU 

Locals 

; 

u 

- 

1 

- 

cappl 

- 

TU 

- 

N 

- 

obliquity 

- 

a 

- 

e 

- 

P 

- 

Inc 

- 

omega 

- 

argp 

- 

nu 

** 

m 

- 

LLong 

LongP 

- 

eO 

_ 

Coupling 

i 

NewtonR 

RandV 

Constants  i 

TwoPl 

References  i 

Danby  pg. 

Escobal  pg.  261-270 


SUBROUTINE  PlanetRV  (  NuaPlanet,JD,  R,V  ) 
IHPLICIT  NONE 

RBAL'8  R(4),V(4),JD 
INTEGER  NuatPlanet 


- -  Locals  - - - 

REAL'S  TUDAySun,u,l,cappl,Tu,n, obliquity, 

&  TwoPi,a»e,p, inc, omega, argp,nu,llong,longp,ra,eO, Rad 

INTEGER  l 

*  -  Implementation  - 

TwoPi  =  6. 28318530717959DO 

Rad  =  57.29577951308230D0 

Tu  =  (  JD  -  2451545. 0D0  )  /  36525. ODO 


Harcury 


IF  (NumPlanet.eq.l)  THEN 

LongP=  1.3518643  4  0.0271656*Tu  4  0.000005166*Tu*Tu 

Omaga=  0.8435332  4  0.0207029*Tu  4  0.000003072*Tu*Tu 

Inc  =  0.1222601  4  0.0000318»Tu  -  0.000000314*Tu*Tu 

a  =  0.2056318  +  0.0000204»Tu  -  0.000QQ0030*Tu*Tu 

LLcng=  4.4026098  42608. 8147071*Tu  4  0.0000053Q6*Tu*Tu 

a  =  0.3871035 

ENDIF 

*  -  Vanus  - 

IF  (NumPlanet.aq.2)  THEN 

LongP*  2.2962193  4  0.0244734*Tu  -  0.00001B727*Tu*Tu 

&  -  0.000000087*Tu*Tu*Tu 

Omaga=  1.3383171  4  0.0157275*Tu  +  0.000007103*Tu*Tu 

Inc  =  0.0592480  +  0.000017S»Tu  -  0.000000017«Tu*Tu 

a  =  0.0067719  -  0.0000478*Tu 

LLong=  3.1761467  41021. 3529430*Tu  4  0.000005428*Tu*Tu 

a  =  0.7233074 

ENDIF 

*  -  Earth  - 

IF  (NumPlanat.aq.3)  THEN 

LongP=  1.7965956  4  0.0300116*Tu  4  0.000008029*Tu*Tu 

Omaga=  0.0000000 
Inc  »  0.0000000 

a  =  0.0167086  -  0.0000420*Tu 

LLong=  17.4614336  4  628. 3319667*Tu  4-  0.000005306»Tu*Tu 

a  =  1.0000116 

ENDIF 

‘  -  Mars  - 

IF  (NuoPlanat.aq.4)  THEN 

LongP=  5.8653576  4-  0.0321323*Tu  4-  0.000000236*Tu*Tu 

Omega=  0.8649519  4-  0.0134756*Tu  +  0.000000279*Tu*Tu 

Inc  a  0.0322838  -  0.0000105*TU  4-  0.000000227»Tu»Tu 

a  =  0.0934006  +  0.0000905»Tu  -  0.000000080*Tu»Tu 

LLonga  6.2034809  -4  334.0856279*Tu  4-  0.000005428*Tu*Tu 

a  =  1.5237107 

ENDIF 

*  -  Jupltar  - 

IF  (NumPlanat.aq.5)  THEN 

LongP*  6.5333138  +  0.0281458*Tu  +  0.000017994»Tu*Tu 

6  -  0.000000070*Tu*TU*Tu 

Omega*  1.7534353  4  0.0178190»Tu  4  0.000006999*Tu*Tu 

Inc  »  0.0227464  -  0.0000959*Tu  4-  0.000000087»Tu*Tu 

a  a  0.0484949  4  0.0001632*Tu  -  0.000000470*Tu*Tu 

LLong*  0.5995465  4  52.9934808»Tu  4-  0.000003910»Tu»Tu 

a  a  5.2102156 

ENDIF 

t  -  Saturn  - 

IF  (NunPlanat.aq.6)  THEN 

LongP>=  1.6241473  *  0.0342741*Tu  4  0.000014626*Tu*Tu 

*  4  0 .000000087 *Tu*Tu*Tu 

Omega=  1.9838376  4  0.0153082*Tu  -  0.000002112»Tu*Tu 

4  -  0.000000035*Tu*Tu*Tu 

Inc  =  0.0434391  -  0.0000652*Tu  -  0.000000262*Tu*Tu 

a  =  0.0555086  -  0.0003468*TU  -  0.000001000*Tu*Tu 

L Long a  0.8740168  4  21.3542956»Tu  4  0.000009076*Tu‘Tu 

4  *  9.5380701 

ENDIF 

*  -  Uranua  - 

IF  (NumPlanot.eq.7)  THEN 

LongP=  3.0195096  4  0.0259422*TU  4  0.000003752*Tu*Tu 

Cxaaga=  1.2916474  4  0.0090954*Tu  4  0.000023387*Tu*Tu 

4  4  0.000000332*Tu«Tu*Tu 

Inc  =■  0.0134948  4  0.0000135*Tu  4  0.000000646*Tu*Tu 

a  =  0.0462959  -  0.0000273*Tu  4  0.000000080*Tu*Tu 

LLong=  5.4812939  4  7.5025431*Tu  4  0.000005306*Tu*Tu 

a  =  19.1833020 

ENDIF 

*  -  Naptuna  - 

IP  (NuaPlanet.aq.8)  THEN 

LongP*  0.8399169  4  0.0248931*Tu  4  0.000006615*Tu*Tu 

Omega*  2.3000657  4  O.0192371*Tu  4  0,000004538*Tu«Tu 

Inc  =  0.0308915  -  0.0001625*TU  -  0.000000140*Tu*Tu 

a  =  0.0089881  4  0.0000064«Tu 

LLong=  5.3118863  +  3.8376877*Tu  4  0.000005393*Tu*Tu 

a  =  30.0551440 

ENDIF 

*  -  plut0  - 

IF  (NuaPlanet.aq.9)  THEN 

Longps  3.9202678 
Oo#ga=  1.9269569 
Inc  =  0.2990156 

a  =  0.2508770 

LLong=  3.8203049 
a  =  39.5375800 

ENDIF 


LLong=  DMOD(  LLong  ,TvoPI  ) 

LongP=  DHOD(  LongP  ,TwoPI  ) 

Omega=  DMOD(  Onega  ,TvoPl  ) 

Argp=  LongP  -  Omega 
M  =  LLong  -  LongP 

CALL  NewTonR{  #,H,  E0,NU  ) 
p=  a*(1.0D0-e*e) 

u  =  0.0D0 
1  =  0.0D0 
Cappl=  O.ODO 

CALL  RAKOV (  P,e, Inc, Omega, Argp,Nu,U,L,CapPl,  R,V  ) 

* 

*  Alternate  method  for  finding  poeltlon  veotor 

*  r(4)  =  (  a»(  1.0-e*a)  )  /  (  1.0+e*Co»(Nu)  ) 

*  r(l)=  r(4)*(  Cos(Nu+Argp)*Co* (Omega )-8ln(Nu+Argp)*Cos( Inc) *Sln(Omega)  ) 

*  r(2)  =  r(4)*(  Co»(Nu+Argp)*Sln(0mega)+81n(Nu+Argp)*Co*(Inc)*Co*(0mega)  ) 

*  r(3)  =  r(4)*Sln(Nu+Argp)*31n(Inc) 


*  -  Calculation*  required  for  reference  to  mean  equator 

N  =  (  JD  -  2451545.000  ) 


Obliquity  =  (23.439  -  0.000000400*H)  /  Rad 

CALL  ROTl(  R  , -Obliquity,  R  ) 

CALL  ROTl(  V  , -Obliquity,  V  ) 

TUDaySun=  54.20765355D0 
DO  10  1=  1,  3 

v ( 1 >  =  v(i)/tuday*un 
10  CONTINUE 

*  IP  (Show.eq. 'Y ' )  THIN 

*  Write!*,*)  'eel  Omega', 

*  t  1  LongP  1 ) 

*  Wrlte(*, 5)  a,E,Inc*rad»Omaga*rad,LongP*rad 

*  Wrlte(*,*)  '  LLong  Argp  H  Nu' 

*  Wrlte(*,6)  LLong»rad,Argp*rad,H*rad,Nu*rad 

*  Wrlte<*,*)  'JD  «  1 ,JD 

*  ENDIP 

»  5  FORHAT(  5(P12.7,1X)  ) 

*  6  FORMAT(  4(P12.7,1X)  ) 

RETURN 

END 


*  C  44  • 


FUNCTION  GEOCENTRIC 


* 

*  This  Function  converts  from  Geodetic  to  Geocentric  latitude.  Notice  that 

*  (1-f)  squared  =  1-eSqrd. 

* 


* 

* 

Algorithm 

t  Find  the  answer 

* 

* 

Author 

i  Capt  Dave  Vallado  USAFA/DFAS 

719-472-4109 

12  Aug  1988 

it 

Inputs 

t 

it 

ie 

Lat 

-  Geodetic  Latitude 

-Pl/2 

-  Pi/2  rad 

* 

Outputs 

i 

* 

* 

Geocentric 

-  Geocentric  Latitude 

-Pi/2 

-  Pi/2  rad 

* 

Locals 

t 

* 

* 

None. 

* 

Constants 

t 

* 

* 

EKSqrd 

-  Eccentricity  of  Earth  squared 

0.00669437999013 

* 

Coupling 

i 

* 

* 

None. 

* 

References 

i 

* 

Escobal 

pg.  136 

* 

Kaplan 

pg.  332-336 

* 


* 


real* 8  FUNCTION  Geocentric  (  Let  ) 
IMPLICIT  NONE 
REALMS  Lat 


* 


i 

* 

* 

* 

* 

« 


REAL* 8  EKSqrd 

-  Initialise  values  - 

EESqrd  =  0.0066943799901300 
Geocentric3  DATAN(  (1.0D0  -  BSSqrd)*DTAN(Lat )  ) 
RETURN 
END 


FUNCTION  INVGEOCKNTRIC 

This  Function  converts  Iron  Geocentric  to  Geodetic  latitude.  Notice  that 
(1-f)  squared  =  1-eSquared. 

Algorithm  i  Find  the  answer 

Author  i  Capt  Dave  Vallado  U8AFA/DFA8  719-472-4109  12  Aug  1988 

Inputs  i 

Lat  -  Geocentric  Latitude  -Pl/2  -  Pl/2  rad 

Outputs  i 

InvGeocentrlc-  Geodetic  Latitude  -Pl/2  -  Pl/2  rad 

Locals  i 

None. 

Constants  t 

EESqrd  -  Eccentricity  of  Earth  squared  0.00669437999013 

Coupling  t 

None. 

References  i 

Escobal  pg.  136 

Kaplan  pg.  332-336 


* 


REAL* 8  FUNCTION  InvGeocentrlc  (  Lat  ) 

IMPLICIT  NONE 
REAL *8  Lat 

REAL* 8  EESqrd 

-  Initialise  values  - 

EESqrd  3  0.006 694 37999013D0 

InvGeocentrlc3  DATAN(  DTAN(Lat)/(1.0D0  -  EESqrd)  ) 
RETURN 
END 


*  C-45  * 


SUBROUTINE  SIGHT 


This  subroutine  takas  tbs  position  vsctors  of  two  satellites  and  determines 
if  there  is  line-of~sight  between  the  two  satellites.  A  spherical  Earth 
with  radius  of  1  DU  is  assiuaed.  The  process  is  to  form  the  equation  of 
a  line  between  the  two  vectors.  Differentiating  and  setting  to  zero  finds 
the  minimum  value/  and  when  plugged  back  into  the  original  line  equation, 
gives  the  minimum  distance.  The  parameter  tmln  is  allowed  to  range  from 
0.0  to  1.0. 


Algorithm 


Author 

Inputs 

R1 

R2 

Outputs 

LOS 

Locals 

ADotB 

TMin 

DlstSqrd 

ASqrd 

BSqrd 

Constants 

None. 

Coupling 

DOT 


:  Find  tmln 

Check  value  of  tmln  for  LOS 
Find  dlst  squared  if  needed 

i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  31  Jan  1990 

-  Position  vector  of  the  first  sat  DU 

-  Position  vector  of  the  second  sat  DU 


-  Line  of  Sight  ‘Yes','No  1 


-  Dot  product  of  a  dot  b 

-  Minimum  value  of  t  from  a  to  b 

-  Distance  aquared  for  min  diet  to  earth  DU 

-  Magnitude  of  A  squared 

-  Magnitude  of  B  squared 


Dot  product  of  two  vectors 


References  t 
None. 


SUBROUTINE  SIGHT  {  R1,R2,  LOS  ) 

IMPLICIT  NONE 
REAL* 8  Rl<4),  R2{4) 

CHARACTER* 3  LOS 
EXTERNAL  DOT 

-  Locals  - 

REAL* 8  Dot, ADotB,  THln, DlstSqrd, ASqrd, BSqrd 

BSqrd  =  R2(4)**2 
ASqrd  =  Rl(4)**2 
ADotB  =  DOT{  R1.R2  ) 

TMin  =  (  ASqrd  -  ADotB  )  /  (  ASqrd  +  BSqrd  -  2.CL0*ADotB  ) 

IF  (  (TMin. It .0. 0D0) . or . (THln.gt .1 . 0D0)  )  THEN 
L08  =  'YES' 

ELSE 

DlstSqrd  =  (1.0D0-THin)*ASqrd  +  ADotB*THin 
IF  (DlstSqrd. gt.l.ODO)  THEN 
LOS  =  'YES’ 

ELSE 

LOS  =  'NO  ' 

ENDIF 
END  IF 

RETURN 

END 


* 

* 


SUBROUTINE  LIGHT 


* 

*  This  subroutine  determines  if  a  spacecraft  is  sunlit  or  in  the  dark  at  a 

*  particular  time.  A  spherical  earth  and  cylindrical  shadow  is  assumed. 

* 


*  Algorithm 


*  Author 

* 

*  Inputs 

*  R 

*  JD 

* 

*  Outputs 

*  Vis 

* 

*  Locals 

*  RtAsC 

*  Decl 

*  RSun 

*  AUDU 


t  Find  the  sun  vector 
Use  the  sight  algorithm  for  the  answer 

»  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  9  Feb  1990 


t 

-  ijk  Position  vector  of  satellite  DU 

-  Julian  Date  of  desired  observation  days 

i 

-  Visibility  Flag  'Yes', 'No  • 

t 

-  Suns  Right  ascension  rad 

-  Suns  Declination  rad 

-  Sun  vector  AU 

-  Conve  sion  from  AU  to  DU 


Constants  t 
None 


Coupling 

SUN 

LNCOM1 

SIGHT 


Position  vector  of  Sun 

Multiple  a  vector  by  a  constant 

Does  Line-of-slght  exist  bewteen  vectors 


References  : 
Bscobal  pg. 


SUBROUTINE  LIGHT  (  R,JD,  VIS  ) 

IMPLICIT  NONE 
REAL* 8  R{ 4 ) , JD 
Character*!  Vis 

*  -  Locals  - 

REAL*8  RSun( 4), AUDU, RtAsc, Decl 

*  -  Implementation  - 

AUDU  =  149599650. 0D0/6378.137D0 

CALL  SUN{  JD, RSun, RtAsc, Decl  > 

CALL  LNCOM1 (  AUDU.RSun,  RSun  ) 

*  Write(*,l0)  ‘RSun  =>'  ,RSun(l) ,R8un(2) ,RSun(3) ,RSun(4) 

*  10  FORMAT (  A5,4(F14.8)  ) 

*  - Is  the  satellite  in  the  shadow  or  not  - 

CALL  SIGHT (  RSun,R,  Vis  ) 

RETURN 

END 

* 


t  c-47  * 


SUBROUTINE  OHS 2 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

■t 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

« 

* 

* 

* 

* 

* 


This  subroutine  determines  the  velocity  and  position  vector  of  the  shuttle 
after  it  performs  the  0H8-2  burn.  Assume  the  burn  and  the  resulting 
velocity  change  are  instanteanous. 

Algorithm  t  Find  the  velocity  vector 
Rotate  to  IJK 

Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  7  Mar  1990 

Inputs  t 

Lat  -  Geodetic  latitude  of  the  shuttle's  Earth  sub- 

point  (Its  NADAR)  before  the  burn.  rad 

Lon  -  Geodetic  longitude  of  the  shuttle's  NADAR  rad 

Alt  -  Altitude  of  the  shuttle  above  the  Earth's  surface  DU 

Phi  -  Shuttle  flight  path  angle  rad 

Az  -  Shuttle  azimuth  angle  rad 

Speed  -  Shuttle  scalar  velocity  with  respect  to  inertial  space  DU/TU 

JD  -  Julian  Date  Ref  4713  B.C. 

Outputs  I 

R  -  Position  vector  of  the  shuttle  after  the  OM32  burn  DU 

V  -  Inertial  velocity  vector  of  the  shuttle  after  OMS2  burn  DU/TU 

Locals  i 

VSEZ  -  Velocity  vector  expressed  In  the  SEZ  frame  DU/TU 

Constants  s 

HalfPl 

Coupling  i 

LSTIHB  -  Find  LST  and  GST 

SITE  -  Find  Site  vector  on  an  oblate  Earth 

ROT 2  -  Rotate  about  the  2  axis 

ROT 3  -  Rotate  about  the  3  axis 

References  : 

None. 


SUBROUTINE  OHS2(  Lat ,Lon, Alt , Phi ,Ax, Speed ,JD,  R*V  ) 

IMPLICIT  NONE 

REAL* 8  Lat,Lon,Alt,Phl,Al,8peed,R(4),V(4),JD 

-  Local  Variabl.t  - 

REAL* 8  GST,  LST,  VSBZ( 4) ,VS(4) , HalfPl ,TeapVeo(4) 

-  Initialise  Variabl.t  - 

HalfPl  =  1 . 57079632679490DO 

CALL  LSTlme(  Lon, JD,  Lat, Gat  ) 

CALL  SITB(  Lat, Alt, Lat,  R,VS  ) 

—  Velocity  vector  In  the  rotating,  Barth-fixed  SBZ  frame 
VSBZ(l)  a  -Speed  *  DC08(Phl)  *  DCOS(Aa) 

VSBZ(2)  =  Speed  *  DCOS(Phl)  *  D8IN(Ax) 

VSBZ{3)  a  speed  *  DSIN(Phl) 

CALL  HAG(  VSBZ  ) 

-  Perform  SBZ  to  IJK  tranaformatlon  - 

CALL  R0T2(  VSBZ,  Lat-HalfPl,  TempVec  ) 

CALL  ROT3(  TempVec,  -L8T  ,  V  ) 

RETURN 

END 


*  C  48  » 


SUBROUTINE  RNGAZ 


*  Thl*  subroutine  calculates  the  Rang*  and  Aslmuth  between  two  specified 

*  ground  point*  on  a  «ph*rlcal  Barth.  Notice  th*  rang*  will  ALWAYS  b* 

*  within  th*  rang*  of  value*  li»t*d  *lnc*  you  do  not  know  th*  direction  of 

*  firing,  long  or  short.  Th*  procedure  will  calculate  Rotating  Barth  ranges 

*  if  th*  TOF  is  passed  in  other  than  0.0. 


*  Algorithm  >  Find  th*  rang* 

*  Calculate  th*  As  noting  all  combinations  of  quadrants 

* 


* 

* 

Author 

l 

Capt  Dave  Vallado  USAFA/DFAS  719- 

-472-4109  25  Aug  1988 

* 

Inputs 

: 

* 

LLat 

- 

Start  Geocentric  Latitude 

-Pi/2  -  Pi/2  rad 

* 

LLon 

- 

Start  Longitude  (WEST  -) 

0.0  -  2P1  rad 

* 

TLat 

- 

End  Geocentric  Latitude 

-Pl/2  -  Pl/2  rad 

* 

TLon 

- 

End  Longltud*  (WB8T  -) 

0.0  -  2P1  rad 

* 

* 

TOF 

- 

Time  of  flight  if  ICBM,  or  0.0 

TU 

* 

Outputs 

1 

* 

Range 

- 

Range  between  points 

0.0  -  Pi  rad 

* 

* 

Aa 

- 

Azimuth 

0.0  -  2P1  rad 

* 

Locals 

1 

* 

it 

Small 

- 

Tolerance 

* 

Constants 

t 

* 

TwoPl 

6.28318S30717959 

* 

Pi 

3.14159265358979 

* 

* 

OmegaEarth 

- 

Angular  rotation  of  Barth  (Rad/TU) 

0.0588335906868878 

* 

Coupling 

t 

* 

* 

None. 

* 

References 

l 

h 

BMW 

pg.  309-311 

* 


SUBROUTINE  RngAz  (  that ,LLon, Tlat, TLon, TOF,  Rang*, Ax  ) 

IMPLICIT  MONK 

REAL* 8  LLat,LLon,TLat,TLon,TOF,Rang*,A* 

-  Locals  - 

real* 8  Small,  PI,  TvoPl ,  Omagalarth 

-  Initialise  values  - 

Pi  =  3.14159265358979O0 

Small  =  O.OOOOOIDO 

OroegaEarth*  O.0588335906868878D0 
TwoPl  *  6. 28318530717959D0 

Range*  0AC0S(  DSIU( LLat ) *DSIN(TLat )  +  DC08(LL»t ) *DCOS(TLat )* 
t  DCOS ( TLon-LLon  +  0m#gaBarth*T0F)  ) 

-  Check  If  rang*  is  0  or  half  th*  Earth  distance  - 

IF  (  DAB8{  DSln( Rang* )*DCos( LLat)  ).LT.  Small)  THEN 
IF  (  DABS(  Range  -  Pi  ).LT. Small  )  THEN 
As*  Pi 
ELSE 

AS*  0.000 
2HDIP 

ELSE 

As*  DACOSt  (  DSIN(TLat)  -  DCOS(Range)  *  OSIN (LLat) )  / 
i  (  0SIN(Rang*)  *  DCOS (LLat) )  ) 

END  IF 

-  Check  If  the  Aalmuth  is  grt  than  180  degrees  - 

IF  (D3IN(  TLon  -  LLon  +  Ooeg*B*rth*TOF  ).LT.O.0D0)  THEN 
Aa*  TwoPl  -  As 
3NDIP 

RETURN 

END 


*  c-  49  * 


SUBROUT IN*  PATH 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  subroutine  determines  the  end  position  for  a  given  range  and  azimuth 
from  a  given  point.  Notice  the  use  of  ATAN2  to  eliminate  quadrant 
problems.  Also,  Geocentric  coordinates  are  used  since  the  Sarth  is 
assumed  to  be  spherical. 

Algorithm  t  Find  the  latitude 

Find  the  chango  in  longitude  noting  quadrant  possibilities 
Calculate  the  longitude 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  25  Aug  1988 


Inputs 

LLat 

lion 

Range 

A2 


Start  Geocentric  latitude 
Start  longitude 
Range  between  points 
Azimuth 


Outputs 

Tlat 

Tlon 


End  Geocentric  latitude 
Knd  longitude 


locals 

SlnDeltaN 

CosDeltaN 

DeltaN 

Small 


Sine  of  Delta  N 

Cosine  of  Delta  N 

Angle  bteween  the  two  points 

Tolerance 


Constants  i 
Pi 

TwoPl 


-Pl/2  -  Pl/2  rad 
0.0  -  2P1  rad 
DU 

0.0  -  2Pi  rad 


-Pl/2  -  Pi/2  rad 
0.0  -  2P1  rad 


rad 

rad 

rad 


3.14159265358979 

6.28318530717959 


Coupling  i 

None. 


References  : 

BMW  pg.  309-311 


*  C-50  * 


SUBROUTINE  Path  (  LLat , LLon , Range ,Az ,  TLat , TLon  ) 
IMPLICIT  NONE 

REAL*8  LLat, LLon, Range, Az, TLat, TLon 

-  Local*  - 

REAL*8  SinDeltaN, CosDeltaN,  DeltaN,  Small,  TvoPi,  Pi 

-  Initialize  values  - 

Pi  *  3. 1415926 535 8979D0 
TvoPi3  6 . 28318530717959D0 
Small3  O.OOOOOOIDO 

Az=  DMOD(  Az, TvoPi  ) 

IF  (LLon.LT.O.ODO)  THEN 
LLon=  TvoPi  +  LLon 
ENDIF 

IF  (Range. GT. TvoPi)  THEN 

Range3  DMOD(  Range, TvoPi  ) 

END  IF 


*  - Find  Geocentric  Latitude  - 

TLat  3  DASIN(  D8 IN ( LLat )*DC08( Range)  + 

&  DC08 ( LLat ) *DSIN ( Rang* ) *0008 ( Az )  ) 

*  - Find  Delta  N,  the  angle  betveen  the  point* - 

IF  ((DABS(DCOS(TLat)) .GT. Small). and. 

&  (DABS (DCOS( LLat ) ) .CT. Small)  )  THEM 

SinDeltaN3  DSIN(Az)*DSIN( Range)  /  DCOS(TLat) 
CoaDeltaN3  (  DC08 ( Rang* )-D8IN( TLa t )*DSIN( LLat )  )  / 
t  (  DCOS ( TLa t)*DC08( LLat)  ) 


DeltaN3  DATan2 (SinDeltaN, CoaDeltaN) 

ELSE 

*  - Case  vhere  launch  is  within  3n*  of  a  Pol*  — 

IF  (DABS(DCOS(LLat)).LE. Small)  THEN 

IF  ((Range. GT. Pi). and. (Rang*. LT.TwoPl))  THEN 
DeltaN3  Az  +  Pi 
ELSE 
END  IF 
ENDIF 

*  - Case  vhere  end  point  1*  within  3n«  of  a  pole  — 

IF  <DABS<  DCOQ(TLat)  ).LE. Small)  THEN 
DeltaN3  O.ODO 
ENDIF 
ENDIF 

TLon*  LLon  +  DeltaN 
IF  (TLon.LT. O.ODO)  THEN 
TLon=  TvoPi  +  TLon 
ENDIF 

IF  ( TLon. CT. TvoPi)  THEN 

TLon3  DHOD(  TLon, TvoPi  ) 

ENDIF 

RETURN 

END 


*  C-51  * 


SUBROUTINE  TRAJIC 


This  subroutine  ca'.culates  the  Range,  Asiisuth,  and  Tine  of  Flight  between 
two  specified  ground  points  for  an  ICBM  with  a  known  Q.  Calculations 
depend  on  knowledge  of  burnout  conditions,  and  the  iterations  are 
performed  for  either  a  high  or  low  trajectory.  Notice  the  ICBH  will  fly 
on  an  inertial  trajectory,  and  values  for  earth  relative  velocities, 
etc.,  are  calculated  after  the  Iteration.  Notice  these  calculations  do 
not  support  trajectories  over  half  the  world  away. 

Algorithm  t  Find  the  Range  and  As  with  0  TOF 
If  the  trajectory  Is  possible, 

Loop  to  find  the  Range  and  At  corrected 
Calculate  influence  coefficients 
Find  velocity  needed 

Author  i  Capt  Dave  Vallado  USAFA/Di’AS  719-472-4109  9  Oct  1988 


Inputs  t 

LLat  -  Start  Geocentric  Latitude  -Pi/2  -  Pl/2  rad 

LLon  -  Start  Longitude  (WSST  -)  0.0  -  2P1  rad 

TLat  -  *nd  Geocentric  Latitude  -Pl/2  -  Pi/2  rad 

TLon  -  End  Longitude  (WEST  -)  0.0  -  2P1  rad 

Rbo  -  Radius  at  burnout  DU 

Q  -  Non-dimensional  Q  performance  bated  on  Inertial  Velocity 

TypePhl  -  Type  of  trajectory,  High  ot  Low  'H',  ‘L* 


Outputs 

Range 

Phi 

TOF 

As 

ICPhl 

ICVbo 

ICRbo 

Vn 


i 

-  Rotating  Range  between  points 

-  Inertial  Flight  Path  Angle 

-  Rotating  Earth  Time  of  Fllgth 

-  Inert  Asimuth 

-  Influence  Coefficient  for  Phi 

-  Influence  Coefficient  for  Vbo 

-  Influence  Coefficient  for  Rbo 

-  Velocity  the  missile  needs  to  provide 


0.0  -  Pi  rad 

rad 

TU 

0.0  -  2P1  rad 
rad/rad 
rad/  du/tu 
rad/rad 
DU/TU 


Locals  i 

Small  -  Tolerance 

QBoMln  -  Minimum  Q  tor  a  given  range 

VRarth 

VBO 

a 

Ecc 

E 

RangeOld 

1  -  Index 


Constants  < 

Pi  3.14159265358979 

OmegaEarth  -  Angular  rotation  of  Earth  (Rad/TU)  0.0588335906868878 
Undefined  -  Flag  for  an  undefined  element  999999.1 

Coupling  t 

HAG  Magnitude  of  a  vector 

RngAz  Finds  the  range  and  Asimuth  between  points 

References  i 

BMW  pg.  293-313 


*  C-52  » 


SUBROUTINE  Trajec  (  LLa  t , LLon ,  TLa t , TLon , Rbo , Q , TypePh 1 , Rang# , 
t  Phi , TOP, As, ICPhi , ICVbO, ICRbO, Vn  ) 

IMPLICIT  NONE 

REAL*8  LLat , LLon , TLat , TLon , Rbo , Q , Range , Ph 1 , TOP , A* , ICPhi , icvbo , 

&  ICRbo,Vn(4) 

CHARACTER  TypePhl 

*  -  Local*  - 

RKAL*8  a , Ecc , B, RangeOld , Vbo, VEarth , OmegaBar th , Small ,Pi , 

&  QboHIn, Undefined 

INTEGER  1 

*  -  Inltlaliz#  values  - 

OmegaBarth3  0.O588335906868878D0 
Small  3  0.000001D0 

Pl  =  3.14159265358979D0 

RangaOld  =  -1 . ODO 
Undefined  3  999999. IDO 
1  =  1 

*  - Iterate  to  find  the  flight  time - 

CALL  RngAz(  LLat, LLon, TLat, TLon, 0. ODO,  Range, As  ) 

A  =  RBO  /  (2. ODO  -  Q) 

QBoKln3  (  2 . 0D0*DSln ( Range/2 . ODO )  )  /  (1.0DO+DSin(Range/2.0DO) ) 
IP  (Q.GB.QboMln)  THEN 

DO  WHILE  ((DABS(RangeOld-Range).GT. Small). and. (  l.lt.20  )) 

*  - Check  for  High  or  Low  Plight  Path  Angle - 

IP  (TypePhl. RQ. 'H' )  THEN 

Phi3  0.5D0*(  (Pl  -  DA8IN(((2.0D0-Q)/Q)* 
s  DSln(Range/2.0D0) )  )-  Range/2. ODO) 

ELSE 

Phl=  0.5D0*(  DASIN(((2.0D0-Q)/Q)*D81n(Range/2.0D0) ) 
t,  -  Range/2. ODO) 

ENDIP 

Ecc  =  DSQRT (  1.0D0  +  0* ( 0-2 • ODO ) +DCOS (Phi )  *DCos ( Phi )  ) 

E  =  DACos (  (8cc-DCo#( Range/2. ODO))  /  (1.0D0-Ecc» 
s  DCos (Range/2. ODO))  ) 

TOP  =  DSQRT(A**3)*2.0D0*(  Pl  -  E  +  KCC*DSIN(E)  ) 

*  Wrlte(*,*)  i,Range*Rad,Phl*Rad,e*Rnd, ecc, TOFU3. 44685 
RangeOld  3  Range 

CALL  RngA»(  LLat, LLon, TLat, TLon, TOP,  Range, A*  ) 

1=  1+1 
ENDDO 

IP  (1.GE.20  )  THEN 

Wrlte(*,*)  'TRAJEC  Not  Converged  In  20  Iteralon*  ' 

ENDIP 

*  -  Evaluate  Influence  Coefficients  for  unit  errors  - 

VBO  =  DSQRT (  Q/RbO  ) 

ICPhi =  {  (  2 ,0D0*D31n(Range  +  2.0DO*Phl)  )  / 
i  DSln(2.0D0*Phl)  )  -  2. ODO 

ICVbo3  (  8 . 0D0*DSln ( Range/2 . ODO ) *DSln ( Range/2 . ODO )  )  / 
t  (  Vbo**3*Rbo*DSin(2.0D0*Phl )  ) 

lCRbo=  (  4 . 0D0*DS in ( Range/2 . ODO ) *DSln ( Range/2 . ODO )  )  / 

S  (  Vbo+*2*RBo**2*DSln(2.0D0*Phl)  ) 

*  -  Find  velocity  Needed,  Relative  Velocity  - 

VEarth3  OmegaBarth  *  DCos (LLat) 

VN(1)=  -VBo*DC03(  Phi  ) *DCOS ( A* ) 

VN(2)3  VBo*DCOS(  Phi  )*D8IN(Az)  -  VEarth 
VN(3)=  VBo*DSIN(  Phi  ) 

CALL  HAG(  VN  ) 

ELSE 

Wrlte(*,*)  'The  ICBM  does  not  have  enough  energy  -  ‘ 
Wrlte(*,»)  'Q  Hln  3  • ,QboHln 
Phi  =  Undefined 
TOP  3  Undefined 
ICPhi3  Undefined 
ICVbo3  Undefined 
ICRbo3  Undefined 
Vn(4)3  Undefined 
ENDIP 

RETURN 

END 


*  C  53  * 


SUBROUTINE  HOHKANN 


This  subroutine  calculates  the  delta  v't  for  a  Hohmann  transfar  for  either 
circle  to  circle,  or  ellipse  to  ellipse.  The  notation  used  is  from  tha 
initial  orbit  (1)  at  point  a,  transfer  is  made  to  the  transfar  orbit  (2), 
and  to  the  final  orbit  (3)  at  point  b. 

Algorithm  i  Find  initial  values 

If  the  orbits  are  both  clr  or  elllp,  find  the  answer 

Author  :  Capt  Dave  Vallado  USAFA/DPA8  719-472-4109  19  Dec  1989 

Inputs  i 

R1  -  Initial  position  magnitude 

R3  -  Final  position  magnitude 

al  -  eccentricity  of  first  orbit 

e3  -  Eccentricity  of  final  orbit 

Nul  -  True  Anomaly  of  first  orbit 

Nu3  -  True  Anoawly  of  final  orbit 

Outputs  t 

DelVa  -  Change  in  velocity  at  point  a  DU  /  TU 

DelVb  -  Change  in  velocity  at  point  b  DU  /  TU 

TOF  -  Time  of  Flight  for  the  transfer  TU 

Locals  t 

SHE1  -  Specfic  Mechanical  Energy  of  first  orbit  DU2  /  TU 

SMB2  -  Specfic  Mechanical  Energy  of  transfar  orbit  DU2  /  TU 

SHE3  -  Specfic  Mechanical  Energy  of  final  orbit  DU2  /  TU 

VI  -  Velocity  of  1st  orbit  at  point  a  DU  /  TU 

V2a  -  Velocity  of  transfer  orbit  at  point  a  DU  /  TU 

V2b  -  Velocity  of  transfer  orbit  at  point  b  DU  /  TU 

V3  -  Velocity  of  final  orbit  at  point  b  DU  /  TU 

al  -  Semi  Major  Axis  of  first  orbit  DU 

a2  -  Sami  Major  Axis  of  Transfer  orbit  DU 

a3  -  Semi  Major  Axis  of  final  orbit  DU 

Constanta  ■ 

Pi  3.14159265358979 

Coupling  i 

Nona. 

References  t 

BMW  pg.  163-166 


DU 

DU 


0  or  Pi  rad 
0  or  Pi  rad 


*  C-54  » 


SUBROUTINE  Hohmann  (  Rl,R3,el,*3,Nul,Nu3,  D#lVa,DalVb,TOF  ) 
IMPLICIT  NONE 

REAL* 8  Rl/RS/el^.Nul/NuS^lVa.DelVbjTOF 

-  Local*  - 

REAL* 8  SME1 , SMK2 , SME3 ,  Vl,V2a,V2b,V3,  al,a2,a3,  PI 

-  Initialise  valuta  - 

Pi  =  3.1415926535897900 

al  =  ( rl* ( 1 . 0D0+el*DCoi (Nul ) ) )  /  (1.000  -  al*al  ) 
a2  =  (  Rl  +  R3  )  /  2.0 

a3  =  ( r  3* ( 1 . QD0+e3*DCoa (Nu3 ) ) )  /  (1.0D0  -  *3*e3  ) 

SME1  =  -1.0D0  /  <2.0D0*al) 

8MS2  =  -1.000  /  (2.0D0*a2) 

SMS3  =  -1.000  /  (2.0DO*a3) 

DelVa=  O.ODO 
DelVb=  O.ODO 
TOP=  O.ODO 

IF  (  («1. It. 1.000) .or . (a3.lt. l.ODO)  )  THEN 

-  ylnd  Delta  v  at  point  a  - 

VI  =  DSQRT(  2.0D0*(  (1.0D0/R1)  +  SHE1  )  ) 

V2a  =  DSQRT (  2.0D0*(  (1.0D0/R1)  +  81^2  )  ) 

DelVa*  DABS(  V2a  -  VI  ) 

-  pln<3  Daita  v  at  point  b  - 

V3  »  DSQRT (  2.0DO*(  (1.0DO/R3)  +  SMX3  )  ) 

V2b  =  DSQRT (  2.0DO*(  (1.0D0/R3)  +  8ME2  )  ) 

DelVb=  DABS(  V3  -  V2b  ) 

-  Find  Tranafar  Time  of  Plight  - 

TOF=  Pi  *  DSQRT (  A2**3  ) 

IF  (Show. eg. )  THEN 
Write(*,*)  •  a2  ',*2 
Wrlt«(*,*)  'VI  *,vl,'  V2a  =  *,v2a 

Write!*,*)  *V2b  ’,v2b,'  V3  *  ',v3,'  TOTAL* , (DelVa+DelVb) 
END  IF 

KNDIF 

RETURN 

END 


*  C  55  * 


SUBROUT  INI  ONETANCENT 


* 

* 

it 

*  This  subroutine  calculates  the  delta  v's  for  a  On*  Tangent  transfer  for  either 

*  circle  to  circle/  or  ellipse  to  ellipse.  The  notation  used  is  from  the 

*  initial  orbit  (1)  at  point  a,  transfer  is  made  to  the  transfer  orbit  (2), 

*  and  to  the  final  orbit  (3)  at  point  b. 

* 

*  Algorithm  i  Find  tht  paranat^rs  for  tha  transfer  orbit 

*  Based  on  the  eccentricity,  find  the  answer 

* 


* 

Author 

1 

Capt  Dave  Vallado  USAFA/DFAS  719-472 

-4109 

19  Dec  1989 

* 

Inputs 

: 

* 

R1 

- 

Initial  position  magnitude 

DU 

* 

R3 

- 

Final  position  magnitude 

DU 

* 

el 

- 

Eccentricity  of  first  orbit 

*3 

- 

Eccentricity  of  final  orbit 

Nul 

- 

True  Anomaly  of  first  orbit 

rad 

Nu2 

- 

True  Anomaly  of  second  orbit 

rad 

Nu3 

- 

True  Anomaly  of  final  orbit 

rad 

Outputs 

: 

DelVa 

- 

Chang*  in  velocity  at  point  a 

DU  /  TU 

DelVb 

- 

Change  in  velocity  at  point  b 

DU  /  TU 

Tor 

- 

Tim*  of  Flight  for  the  transfer 

TU 

Locals 

s 

SHE1 

- 

Specfic  Mechanical  Energy  of  first  orbit 

DU2  /  TU 

SMB2 

- 

Specfic  Mechanical  Energy  of  transfer 

orbit 

DU2  /  TU 

SMB  3 

- 

Specflo  Mechanical  Energy  of  final  orbit 

DUX  /  TU 

VI 

- 

Velocity  of  1st  orbit  at  point  a 

DU  /  TU 

V2a 

- 

Velocity  of  transfer  orbit  at  point  a 

DU  /  TU 

V2b 

- 

Velocity  of  transfer  orbit  at  point  b 

DU  /  TU 

V3 

- 

Velocity  of  final  orbit  at  point  b 

DU  /  TU 

*2 

- 

Eccentricity  of  second  orbit 

al 

- 

Semi  Major  Axis  of  first  orbit 

DU 

a2 

- 

Sami  Major  Axis  of  Transfer  orbit 

DU 

a3 

- 

8eml  Major  Axis  of  final  orbit 

DU 

E 

- 

Eccentric  anomaly  of  transfer  orbit  at 

b 

rad 

Constants 

s 

None. 

Coupling 

: 

None. 

References 

t 

BMW 

pg.  163—166 

* 


»  C-5*  * 


SUBROUTINE  OneTangent  {  Rl,R3,#l,*3,Nul,Nu2,Nu3,  D«lVa, 


t  D#lVb,TOP  ) 

IMPLICIT  NONE 

REAL* 6  Rl,R3,el,#3,Nul,Nu2,Nu3,D#lVa,D#lVb,TOF 

*  -  Local*  - 

RBAL*8  SMK1 i SKE2 , SHE3 ,  Vl,V2#,V2b,V3,  #2,al,a2,a3,  Phl2b,Phi3, 
i  8,  sinv,CofV 


*  -  Inltialls#  value*  — - - 

al  =  ( r 1* ( 1 . 0D0\ «l*DCo* ( Nui ) ) )  /  (l.ODO  -  #l*#i  ) 

•2  *  (  t3-rl  )  /  <  -r 3*DCo# ( Nu2 ) +DCo» ( Nul )*rl  ) 

*  Cos(Nul)  dataralnas  th*  ilgn 

IF  (  DAB8(  #2-1. 0D0  )  .gt.  O.OOOIDO  )  THEN 

a2  *  ( tl* ( 1 . 0D0+e2*QCo* (Nul ) ) )  /  (l.ODO  -  #2*#2  ) 

SMS2  *  -l.ODO  /  (2.0DO*a2) 

ELSE 

*2  *  999999. 9D0 

*  Undef  lr.td  for  Parabolic  orbit 

SMX2  »  0.0D0 
BNDIF 

a3  =  ( r 3* ( 1 . ODO+i J*DCo* (Nu3 ) ) }  /  (l.ODO  -  #3**3  ) 

SHE1  *  -l.ODO  /  (2.0D0*al) 

SME3  a  -l.ODO  /  (2.0DG*a3) 

*  -  find  Dalta  v  at  point  a  - 

VI  *  D3QRT(  2.0D0*(  (1.0/R1)  t  8MX1  )  ) 

IF  (  DAB$(  SKX2  )  .gt.  O.OOOIDO  )  THEN 

V2a  “  D8QRT (  2.0*(  (1.0D0/R1)  +  BMX2  )  ) 

ELSE 

V2a  »  DSORT(  2.0*(1.0D0/R1)  ) 

BNDIF 

D#lVa=  DABS(  V2a  -  VI  ) 

*  -  Find  D«lta  v  at  point  b  - 

V3  *  DSQRT (  2 . 0D0* (  (1.0DO/R3)  +  8MB3  )  ) 

IF  (  DABS(  SKE2  )  .gt.  O.OOOOOIDO  )  THEN 

V2b  =  DSQRT (  2.0D0*(  (1.0D0/R3)  4-  8HE2  )  ) 

ELSE 

V2b  ■  DSQRT (  2 . ODO* ( 1 . ODO/R3 )  ) 

ENDIF 

Phi 2b  n  DAT AW (  (  #2*DSln(Nu2)  )  /  (  l.ODO  +■  #2*DCo*(Nu2)  )  ) 
Phl3  a  DATANf  (  #3«D8l.i(Nu3)  )  /  (  l.ODO  +  #3*DCo*(Nu3)  )  ) 
D#lVba  DSQPTf  V2b»V2b  +  V3*V3  - 


i  2 . 0D0*V2b*V3*DCo* (  Phl2b-Pbl3  )  ) 

* -  Find  Tran*f#r  Visa  of  Flight  - 

IF  (  #2  .It.  0.9999D0  )  THEN 

Slnv  *  (  DSQRT (  1.0DO-#2*#2  >*D8ln(Nu2)  )  / 
l  (  l.ODO  *  #2*DCo*(Nu2)  ) 

C0*v  *  (  #2+DCoa(Nu2)  )  /  (  l.ODO  +  #2*DCo»(Nu2)  ) 
8  *  DAT AW 2 (  SlnVtCOIV  ) 

TOF  *  DSQRT (  A2»*3  )  *  (  E  -  #2*DSln(E)  ) 

ELSE 

IF  (  DABS(  02-1. ODO  )  .It.  O.OOOOOIDO  )  THEN 


*  Parabolic  TOF 

ELSE 

*  Hyperbolic  TOP 

ENDIF 

ENDIF 

*  IP  Show  =  *  Y •  THEN 

*  BEGIN 

*  GoToXX<  5,23  ) 

*  Writ#(  'e2  ',#211015, *  8  *  • ,B*radilOi6, '  *2  *,a2il0i6  ) 

*  Gotoxy(  5,24  ) 

»'  Wrlto(  'VI  ' ,  vlil0i5, '  V2a  *  *,v2ail0i5  ) 

*  Gotoxy(  5,25  ) 

*  Write)  *V2b  1 ,v2b:10i5, 1  V3  =  ',v3ilO»6,'  TOTAL  ', 

*  (DelVa+DelVb) 1IO16  ) 

*  Cotoxy(  5,26  ) 

*  Wrlte(  'Phi 2  ' ,Phl2b»Radil0i6, '  Phl3  ®  '  ,Phl3«RadilOi6  ) 

*  2ND 

RETURN 

END 


e  c-57  * 


SUBROUTINE  GENKRALCOPLANAR 


This  SUBROUT INK  calculates  tbs  delta  v's  for  a  general  coplanar  transfer  for 
either  circle  to  circle*  or  ellipse  to  ellipse.  The  notation  used  Is  from 
the  Initial  orbit  (1)  at  point  a*  transfer  Is  made  to  the  transfer  orbit  (2), 
and  to  the  final  orbit  (3)  at  point  b. 

Algorithm  t 

Author  t  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  19  Dec  1969 

Inputs  t 

R1  -  Initial  position  magnitude 

R3  -  Final  position  magnitude 

el  -  Eccentricity  of  first  orbit 

e3  -  Eccentricity  of  final  orbit 

Nul  -  True  Anomaly  of  first  orbit 

Nu3  -  True  Anoauly  of  final  orbit 


Outputs  s 

DelVa  -  Change  In  velocity  at  point  a  DU  /  TU 

DelVb  -  Change  In  velocity  at  point  b  DU  /  TU 

TOF  -  Time  of  Flight  for  the  transfer  TU 

Locals  i 

SME1  -  Specflc  Mechanical  Energy  of  first  orbit  DU2  /  TU 

SME2  -  specflc  Mechanical  Energy  of  transfer  orbit  DU2  /  TU 

8ME3  -  Specflc  Mechanical  Energy  of  final  orbit  DU2  /  TU 

VI  -  Velocity  of  1st  orbit  at  point  a  DU  /  TU 

V2a  -  Velocity  of  transfer  orbit  at  point  a  DU  /  TU 

V2b  -  Velocity  of  transfer  orbit  at  point  b  DU  /  TU 

V3  -  Velocity  of  final  orbit  at  point  b  DU  /  TU 

al  -  Semi  Major  Axis  of  first  orbit  DU 

a2  -  Semi  Major  Axis  of  Transfer  orbit  DU 

a3  -  Semi  Major  Axis  of  final  orbit  DU 

E  -  Eccentric  anomaly  of  transfer  orbit  at  b  rad 


Constants  i 

Hone. 

Coupling  i 

Nona. 

References  i 

BMW  pg. 


DU 

DU 


rad 

rad 


SUBROUTINE  G*n*ralCoplanar  (  Fl,R3,*l,*2,*3,Nul,Nu2a,Nu2b«Nu3, 
t  D*lVafD*lVb,TOF  ) 

IMPLICIT  NONE 

REAL* 8  R1 , R3 , *1 , *2 , *3 , Nul , Nu2a ,Hu2b,Nu3 , D*lVa , 

&  D*lVb,TOF 


*  -  Local*  - 

REAL* 8  8MB1 , SHE2 , SHI3 ,  Vl,V2a, V2b,V3,  al,a2,a3,Phil,Phi2a, 
t  Phi2b,Phi3,  E,EO,Sinv,Co*V 

*  -  Initial!.**  valuta  - 

al  =  (tl*(1.0D0+*l*DCo»(Nul) ) )  /  (1.0D0  -  •!*•!  ) 


IP  (  DABS(  *2-1.000  )  .gt.  0.00000 IDO  )  THEN 

a2  =  (rl*(1.0D0+*2*DCo»(Nu2a) ) )  /  (1.0D0  -  *2**2  ) 
SHS2  =  -1.0D0  /  (2.0D0*a2) 

ELSE 

a2  =  999999. 9D0 
*  Und*fin»d  Cor  Parabolic  orbit 
SMB 2  s  0.0D0 
KNDIF 

a3  *  (r3*(1.0D0+*3*DCo»(Nu3) ) )  /  (1.000  -  *3**3  ) 


SME1  *  -1.0D0  /  ( 2.0DO*al) 

SME3  =  -1.0D0  /  (2.0DO»*3) 

* -  rind  D*lta  v  at  point  a 


VI  =  DSQR?(  2.0D0*(  (1.0D0/R1)  +  SME1  >  ) 

V2a  *  D9QRT{  2.0D0*(  (l.ODO/Rl)  +  8KE2  )  ) 

Phl2a  »  DATAN(  (  *2»DBin(Nu2a)  )  /  (  1.0D0  +  *2«DCo*(Nu2a)  )  ) 
Phil  =  DATAN(  (  *l*DSln(Nul)  )  /  (  l.ODO  +  *l*DCo*(Nul)  )  ) 
D*lVa°  D8QRT (  V2a*V2a  +  V1*V1  - 

2 . ODO* V2a*Vl*DCo* (  Phl2a-Phil  )  ) 


*  -  rind  D*lta  v  at  point  b  - 

V3  =  DSQRT (  2.0D0*(  (1.0D0/R3)  +  SME3  >  ) 

V2b  3  DSQRT (  2.0D0*(  (1.0D0/R3)  +  SME2  )  ) 

Phl2b  =  OAT AN (  (  *2*D6in(Nu2b)  )  /  (  l.ODO  +  *2*DCo*(Nu2b)  ) 
Phi 3  3  DATAN(  (  *3*OSin(Nu3)  )  /  (  l.ODO  +  *3»DCo*(Nu3)  )  ) 
D*lVb=  DSQRT (  V2b*V2b  +  V3*V3  - 
t  2 . 0D0*V2b*V3*DCo* (  Phl2b-Phl3  )  ) 

*  -  rind  Tr»n«f#r  tIm  of  Plight  - - 

Sinv*  (  DSQRT (  1.0DC-*2«*2  )*DSin(Nu2b)  )  / 
t  (  l.ODO  *  *2*DCo*(Nu2b)  ) 

Coav*  (  *2+DCo*(Nu2b)  )  /  (  1.0  ♦  *2*DCo*(Nu2b)  ) 

E*  DATAN2(  8inv,Co*v  ) 

Sinv3  (  DSQRT (  1.0D0-*2**2  )*D8in(Nu2a)  )  / 

&  (  l.ODO  +  *2*DCo*(Nu2a)  ) 

Coav=  (  *2tDC0»(Nu2a)  )  /  (  l.ODO  +  *2*DCo»(Nu2a)  ) 

Eo=  DATAN21  Slnv,C0*V  ) 

TOP*  DSQRT (  A2**3  )*(  (E  -  *2»D8in{B))  -  (Eo  -  *2*D8in(EO))  ) 


RETURN 

END 


*  C  b9  * 
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SUBROUTINE  RENDEZVOUS 

This  subroutine  calculates  parameters  for  a  hohmann  transfer  rendezvous. 
Algorithm  :  Calculate  the  answer 

Author  >  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  23  8ep  1986 

Inputs  t 

Rcsl  -  Radius  of  circular  orbit  interceptor 

Rcs2  -  Radius  of  circular  orbit  target 

Phasel  -  Initial  phase  angle 

NuaRevs  -  Number  of  revs  to  wait 

Outputs  i 

PhaseF  -  Final  Phase  Angle  rad 

WaitTlme  -  Wait  befor  next  intercept  opportunity  TU 

Locals  i 

TOFTrans  -  Time  of  flight  of  transfer  orbit 
ATrans  -  Semi-major  axis  of  transfer  orbit 

VelTgt  -  Velocity  of  target 

Vellnt  -  Velocity  of  interceptor 

LeadAng  -  Lead  Angle 

Constants  i 

Pi  3.14159265353979 

Coupling  t 

None. 

References  i 

BMW  pg. 


DU 

DU 

rad 


SUBROUTINE  Rendezvous  {  Rc»l,Rcs2, Phasel, NuaRevs, Phaser, WaitTlme) 
IMPLICIT  NONE 

REAL* 8  Rcsl, Ros2,PhaseI, PhaseF, WaitTlme 
INTEGER  NumRavS 

-  Locals  — — - - - 

REAL* 8  TOFTrans , LeadAng , aTr an* , VelTgt , Vellnt , Pi 

-  Initialize  values  - 

PI  =  3. 1415926 5358979D0 

ATrans  =  (Rcsl  +  RC32)  /  2.0DO 
TOFTrans®  Pl*D80RT(  ATrans**3  ) 

Vellnt  =  l.ODO  /  (  DSQRT(Rcsl»*3)  > 

VelTgt  *  l.ODO  /  (  DSQRT( Res 2**3)  ) 

LeadAng  =  VelTgt  *  TOFTRans 
PhasaP  =  Pi  -  LeadAng 

WaitTlme®  (  Phasel  -  PhaseF  +  2.CD0*Pl*Nu*Pavi  )  / 
t  (  Vellnt  -  VelTgt  ) 

Wrlte(»,*)  '  A  transfer  =  ' ,ATRans,  '  DU  ' 

Wrlt*(»,*)  •  TOF  Transfer*  VTOFTRans,'  TU  ' 

Wrlte(*,*)  •  VelTgt  =  1 , VelTgt,  '  rad/TU' 

Wrlte(*,»)  ’  Vellnt  =  ', Vellnt,  '  rad/TU* 

Wrlte(*,*)  '  Lead  Angle  =  • ,LeadAng*57. 295779, *  deg* 


RETURN 

END 
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SUBROUTINE  INTERPLANETARY 

This  subrout ins  calculates  the  delta  v's  for  an  interplanetary  mission.  The 
transfer  assumes  circular  orbits  for  each  of  the  planets.  Notice  the 
units  are  all  metric  since  this  procedure  is  designed  for  ANY  planet  and 
sun  system.  This  eliminates  having  knowledge  of  cannonlcal  units  for 
each  planet  in  the  calculations. 

Algorithm  :  Calculate  the  answer 

Author  i  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  22  Har  1989 


Inputs  * 

R1  -  Radius  of  planet  1  from  sun  km 

R2  -  Radius  of  planet  2  from  sun  km 

Rbo  -  Radius  at  burnout  about  planet  1  km 

Riapact  -  Radius  at  Impact  on  planet  2  km 

Mul  -  Gravitational  parameter  of  planet  1  km3/s2 

Hut  -  Gravitational  parameter  of  planet  Sun  km3/s2 

Mu2  -  Gravitational  parameter  of  planet  2  km3/s2 

Outputs  i 

Deltvi  -  Hyperbolic  Excess  velocity  at  planet  1  SOI  km/s 

DeltV2  -  Hyperbolic  Excess  velocity  at  planet  2  SOI  km/s 

Vbo  -  Burnout  velocity  at  planet  1  km/s 

Vretro  -  Retro  velocity  at  surface  of  planet  2  km/s 

Locals  t 

SHEl  -  Specfic  Mechanical  Energy  of  1st  orbit  Km2/s 

SKEt  -  Specfic  Mechanical  Energy  of  transfer  orbit  Ka2/s 

SMB2  -  Specfic  Mechanical  Energy  of  2nd  orbit  Km2/s 

Vcsl  -  Velocity  of  1st  orbit  at  delta  v  1  point  km/s 

Vcs2  -  Velocity  of  2nd  orbit  at  delta  v  2  point  Km/s 

Vtl  -  Velocity  of  Transfer  orbit  at  delta  v  1  point  Km/s 

Vt2  -  Velocity  of  Transfer  orbit  at  delta  v  2  point  Km/s 

A  -  Semi  Major  Axis  of  Transfer  orbit  Km 


Constants  s 

None. 

Coupling  t 

None. 

References  i 

BMW  pg. 


*  C-61  * 


SUBROUTINE  Interplanetary  (  Rl,R2,Rbo,Rlnpact,Mul,Mut,Mu2, 
t  Deltvl,D*ltv2,Vbo,Vratro  ) 

IMPLICIT  NONE 

REAL* 8  Rl,R2,Rbo,Rimpact,Mul,Hut,Hu2,Daltvl,Deltv2, Vbo, 
i  Vratro 


-  Local*  - 

REAL* 8  SMS1 , SMI 2 , SME  t /  Veal,  Vci2,  Vtl,  Vt2,  A 


—  Find  a,  SME,  apogee  and  perigee  valocltiaa  of  tranafar  orbit  - 

A=  (R1+R2)  /  2.0D0 
SMEt=  -MUt/  (2.0D0*A) 

Vtl=  DSQRT(  2.0M*(  (Mut/Rl)  +  SMSt  )  ) 

Vt2=  DSQRT(  2.0D0*(  (Mut/R2)  +  SMXt  )  ) 

-  Find  circular  valocltiaa  of  launch  and  targat  planata  - 

Vcsl=  DSQRT(  Mut/Rl  ) 

Vc*2=  DSQRTf  Mut/R2  ) 


—  Find  dalta  valocltiaa  for  Kohmann  tranafar  protion 
DaltVl=  DABS(  Vtl  -  Veal  ) 

DeltV2=  DAB8(  Vca2  -  Vt2  ) 


Find  SMB  and  burnout/ laqpact  val  of  launch/targat  planata 

SME1=  Daltvl*DaltVl  /  2.0D0 

SME2*  Daltv2*DaltV2  /  2.OD0 

Vbo  *  DSQRT(  2 . ODD* (  (Mul/Rbo)  +  8ME1  )  ) 

Vratro=  DSQRT(  2.0D0*(  (Mu2/Rlaq?act)  +  SMB2  )  ) 


TP=  P1*DSQRT(  a**3/Mut  ) 

wrlta(*,*)  'Tranafar  Period  =  '.TP/3.1536E07, ’  yra 
TP/86400.0,'  daya' 

Wrlta(*,*)  'Vca  ka^/a' ,vcal,'  ',vca2 
wrlta(»,«)  1  Vt  ka/a'.vtl,'  ',vt2 
Wrlto(*,*)  'SME  ka2/*2' ,8ME1, '  '.SMEt,'  ',SMS2 


RETURN 

END 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


* 


* 


* 


SUBROUTINE  REENTRY 

This  SUBROUTINE  calculate  varloua  reentry  parameter!  uaing  the 
Allen  t  tggara  approximation*. 


Algorithm 

Author 

Inputs 

Vre 

PhlRe 

BC 

h 

Outputs 

V 

Oecl 

MaxDecl 

Locals 

grav 

Rho 

Constants 

ScaleHt 

Coupling 

Hone. 

References 

None. 


i  Calculate  the  answer 

»  Capt  Dave  Vallado  U8APA/DFAS  719-472-4109  19  Dec  1989 


-  Reentry  Velocity 

-  Reentry  flight  Path  Angle 

-  Ballistic  Coefficient 

-  Altitude 


-  Velocity 

-  Declaration 

-  Maximum  Declaration 


»/* 

rad 

kg/m2 

km 


km/s 

g'a 

g's 


-  Temporary  variable  to  hold  weight  component 

-  Atmospheric  density  kg/m3 


-  Scale  height  used  to  exponentially  model  atmosp  1.0/7.315 


SUBROUTINE  Reentry  (  VR*,PhiRe,BC,H,  V,D*cl, MaxDecl  ) 
IMPLICIT  HONE 

real* 6  VRa,PhiKa,BC,H,  v,Deel, MaxDecl 

-  Locals  - 

RIAL* 8  ScaleHt, grav ,Rho 

-  Implementation  - 

ScaleHt*  1.0D0/7.315D0 

Rho  »  1.225D0*EXP(  -ScaleHt*h  ) 

V  *  Vre  *  EJ£P(  (1000.0D0*Rho  )  / 

S  (2.0D0*BC*ScaleHt*DSln(PhlRe) )  ) 

grav*  9.flODO»DSln(PhlRe) 

Decl»  ((-0.5D0»Rho*V*V)  /  BC  )  +  grav 
Dacl*  Decl/9,80DO 

MaxDecl-  <-0.5D0*ScaleHt*Vre*Vre*DSin{Phlre))  / 

(,  (9.80DO*EXP(1.0DO)) 

MaxDecl*  HaxDecl/9 . 80D0 

RETURN 

END 


* 

*  SUBROUTINE  HILLSR 

* 

*  This  SUBROUTINE  calculates  various  position  information  for  Hills  equations. 

*  Notice  the  XYZ  system  used  has  Y  Colinear  with  Target  Position  vector, 

*  Z  normal  to  target  orbit  plane,  and  x  in  direction  of  velocity. 


* 

* 

Algorithm 

s  Find  the  answer 

* 

* 

Author 

i  Capt  Dave  Vallado  usafa/dfas 

719-472-4109 

19  Dec  1989 

* 

Inputs 

s 

* 

R 

-  Initial  Position  vector  of  INI 

DU 

* 

V 

-  Initial  Velocity  Vector  of  INT 

DU 

/ 

TU 

★ 

Alt 

-  Altitude  of  TOT  satellite 

DU 

* 

it 

T 

-  Desired  Time 

TU 

* 

Outputs 

i 

* 

R1 

-  Final  Position  vector  of  INT 

DU 

* 

* 

VI 

-  Final  Velocity  Vector  of  INT 

DU 

/ 

TU 

* 

it 

Locals 

t 

* 

it 

Constants 

t 

* 

Coupling 

t 

* 

it 

None. 

* 

References 

> 

* 

Kaplan 

pg  108  -  115 

* 


SUBROUTINE  HlllsR  (  R,V,alt,t,  R1,V1  ) 
IMPLICIT  NONE 


REAL* 8  R(4),V(4) ,alt,t,  R1(4),V1(4) 


-  Locals  - 

real* 8  SinNt, CosNt, Oa*ga,nt, Radius 

-  Initialise  the  orbit  elemnts 

Radius®  l.ODO  +  Alt 

Omega  =  DSQRT(  1.000  /  Radius  ) 

nt  =  0mega*t 

CosNc  =  DCos(  nt  ) 

SinNt  =  DSln(  nt  ) 


* - Determine  new  positions  - 

Rl(l)=  (  2.0D0*V(2)/Omega  )  *  CosNt  + 
t  (  ( 4 . 0D0*V(  1  )/0mega )  4-  6.0D0*R(2)  )  *  SinNt  + 

i  (  R(l)  -  (2.0D0*V(2)/Oaega)  )  - 

t  (  3.0D0*V(1)  +  S.ODO*Omega*R(2)  )*t 

Rl(2)=  (  V(2)/0mega  )  *  SinNt  - 
t  (  (2.0D0*V(l)/Oatega)  4-  3.0D0*R(2)  )  *  CosNt  4 

I  (  ( 2 . 0D0* V(  1  )/0maga )  4-  4.0DO*R(2)  ) 

R1  ( 3 ) =  R( 3)*CosNt  4  (V(3)/0mega)*SlnNt 


-  Determine  new  velocities 

Vl(2)=  0.0D0 
Vl(l)=  0.0D0 
Vl(3)=  0.0D0 


RETURN 

END 


* 

* 

* 


SUBROUT INS  HILLSV 


This  SUBROUTINE  calculates  Initial  vsloclty  for  Kills  aquations. 

Notlca  tha  XYZ  system  us ad  has  Y  Colinaar  with  Target  Position  vaotor, 
Z  normal  to  targat  orbit  plans*  and  a  In  diractlon  of  valoclty. 


* 

Algorithm 

>  Check  for  a  divide  by  zero* 

than 

* 

it 

Find  tha  answer 

* 

it 

Author 

:  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  19 

* 

Inputs 

J 

* 

R 

-  Initial  Position  vector  of 

INT  DU 

* 

Alt 

-  Altitude  of  TGT  satellite 

DU 

It 

it 

T 

-  Desired  Time 

TU 

* 

Outputs 

i 

* 

* 

V 

-  Initial  Velocity  Vector  of 

INT  DU  /  TU 

* 

it 

Locals 

s 

* 

it 

Constants 

i 

it 

Coupling 

s 

it 

it 

Nona. 

it 

References 

t 

it 

Xaplan 

pg  108  -  115 

SUBROUTINE  HlllsV  (  R,alt,t,  V  ) 

IMPLICIT  NONE 

REAL* 8  R(4),alt,t,  V(4) 

-  Locals  - 

real* 8  Numar, Denom* SlnNt, CosNt, Omega, nt , Radius 

-  Inltlallsa  tha  orbit  alamnts  — 

Radius^  l.ODO  +  Alt 

Omega  =  dsqrt(  l.ODO  /  Radius  ) 

nt  a  Omega* t 

CosNt  »  DCoa(  nt  ) 

SlnNt  x  DSln(  nt  ) 


*  -  Datarmlna  Initial  Velocity  - 

Numar*  (  (6.0D0*r(2)*(nt-BINnT)-r(l))*Omega*8innt-2.0D0»Oa»ega* 
t  r  { 2 ) * ( 4 . 0D0-3 . 0D0*Coant ) * ( 1 . ODO-COSnt )  ) 

Danoma  (4.0D0*Sinnt-3.0O0*nt)»81nnt  + 
t  4.0D0*(  l.ODO -CosNt  )  *  (  l.ODO -CosNt  ) 


IF  (  DAB8(  Danom  )  .gt.  O.OOOOOIDO  )  THEN 
V(l)=  Numar  /  Danoa 
ELSE 

V(l)=  O.ODO 

END  IF 

IF  (  DABS(  SlnNt  )  .gt.  O.OOOOOIDO  )  THEN 
V(2)=  -(  Omega*r(2)*(4.0D0-3.0D0*Cosnt)+ 
t  2. 0D0*(1. ODO-Cosnt )*v(l)  )  /  (  SlnNt  ) 

ELSE 

V(2)=  O.ODO 
ENDIF 

V(3)3  O.ODO 

RETURN 

END 


*  C-65  * 


* 

* 

* 

* 

* 

* 

t 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


SUBROUT IN*  TARGET 

This  subroutine  accoaplishes  the  targeting  problem  using  PKEPLER  and  GAUSS. 
This  routine  uses  J2  secular  perturbations  for  moving  the  traget  orbit. 

Algorithm  :  Propogate  the  target  forward 
rind  the  intercept  trajectory 
Calculate  the  change  in  velocity  required 

Author  >  Cape  Dave  Vallado  USATA/DFAS  719-472-4109  11  Sep  1990 


Inputs  i 

RInt  -  Initial  Position  vector  of  Interceptor  DU 

Vint  -  Initial  Velocity  vector  of  Interceptor  DU/TU 

RTgt  -  Initial  Position  vector  of  Target  DU 

VTgt  -  Initial  Velocity  vector  of  Target  DU/TU 

dm  -  Direction  of  Notion  for  Gauss  ‘LVS* 

TOP  -  Time  of  flight  to  the  Intercept  TU 

Outputs  : 

Vlt  -  Initial  Transfer  Velocity  vector  DU/TU 

V2t  -  Final  Transfer  Velocity  vector  DU/TU 

DV1  -  Initial  Change  Velocity  vector  DU/TU 

DV2  -  Final  Change  Velocity  vector  DU/TU 

local  Variables  t 

RITgt  -  Position  vector  after  TOP  of  Target  DU 

VITgt  -  Velocity  vector  after  TOP  of  Target  DU/TU 


Constants  i 

None 

Other  Procedures  t 

PKEPLER  Find  R  and  V  at  future  time  using  J2  secular  effects 

GAUSS  Find  velocity  vectors  at  each  end  of  transfer 

LNCOM2  linear  combination  of  two  vectors  and  constants 

References  i 

None. 


SUBROUTINE  TARGET (  RInt, Vint, RTgt,VTgt,Dm,TOF,  Vlt,V2t,DVl,DV2  ) 
IMPLICIT  NOME 

REAL* 8  RInt ( 4 ) ,VInt(4) ,RTgt ( 4 ) , VTgt ( 4) ,TOP,Vlt ( 4) , V2t { 4) , 

+  DV1(4),DV2(4) 

CHARACTER*  1  da 

-  local  Variables  - 

REA1*8  RITgt (4) ,  Vlfgt(4) 

-  Propogate  Target  forward  by  TOP  - — 

CALI  PKEP1ER(  RTgt, VTgt, TOP,  RITgt, VITgt  ) 

-  Calculate  transfer  orbit  between  r's  - - — - - 

CALI  GAUSS {  RInt, RITgt, da, TOP,  Vlt,V2t  ) 

CALL  LNC0H2{  -1.0D0, 1 . 0D0,VInt ,  Vlt,  DV1  ) 

CALL  LNC0H2{  l.ODO.-l.ODO, VITgt, V2t,  DV2  ) 

RETURN 

END 


*  C  L6  ‘ 


SUBROUTINE  PXEPLKR 


*  This  subroutine  propagates  a  satallita's  position  and  velocity  vactor  ovar 

*  a  given  tlma  parlod  accounting  for  perturbations  cauaad  by  J2.  Tha 

*  satallita's  original  position  and  valoclty  vactors  ara  inputad  togethar 

*  with  tha  tlma  tha  alaaants  ara  to  ba  propagatad  for.  Tha  updatad  position 

*  and  valoclty  vactors  ara  than  output. 

* 

*  Algorithm  t  Find  tha  valua  of  tha  parturbatlons 

*  Determine  tha  typa  of  orbit 

*  Updata  tha  appropriate  paraaatars 

*  Find  tha  naw  position  and  valoclty  vactors 

* 

*  Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  S  Jan  1990 


*  Inputs  i 

*  P.  -  original  position  vactor  DU 

*  V  -  original  velocity  vactor  DU/TU 

*  DsltaT  -  time  for  which  orbital  elements  ara  to  TU 

*  Outputs  « 

*  Ri  -  updatad  position  vactor  DU 

*  VI  -  updatad  valoclty  vactor  DU/TU 

*  Bocals  i 

*  P  -  8ami-paraater  DU 

*  A  -  semimajor  axis  DU 

*  E  -  eccentricity 

*  Inc  -  inclination  rad 

*  Argp  -  argument  of  perlapsis  rad 

*  ArgpDot  -  change  in  argument  of  perlapsis  rad/TU 

*  Omega  -  longitude  of  the  ascending  node  rad 

*  OmegaDot  -  change  In  Osmga  rad 

*  E0  -  eccentric  anomaly  rad 

*  81  -  eccentric  anomaly  rad 

*  H  -  mean  anomaly  rad/TU 

*  HDot  -  change  In  mean  anomaly  rad/TU 

*  Uo  -  argument  of  latitude  rad 

*  UDot  -  change  in  argument  of  latitude  rad/ru 

*  Bo  -  true  longitude  of  vehicle  rad 

*  BDot  -  change  in  tha  true  longitude  rad/TU 

*  CapPlo  -  longitude  of  perlapsis  rad 

*  CapPloDot  -  longitude  of  perlapsis  change  rad/TU 

*  N  -  mean  angular  sntlon  rad/TU 

*  NUo  -  true  anomaly  rad 

*  J2oP2  -  J2  ovar  p  sqyared 

*  SlnVfCosv  -  Sins  and  Cosine  of  Mu 

*  Small  -  Tolerance 


Constants  i 

J2  -  J2  constant  from  the  Berth's  geopotential  function 

TwoPl 

PI 

Coupling  i 

EBORB  -  Orbit  Elements  fros  position  and  Velocity  vectors 

RANDV  -  Position  and  Velocity  Vactors  from  orbit  elements 

NevtonR  -  Newton  Rhapson  to  find  Hu  and  Eccentric  anoaialy 

References  i 

Bscobal  pg  369.  Dot  terms 

BHW  pg 


SUBROUTINE  PKepler  (  R,V, DaltaT,  R1,V1  ) 

IMPLICIT  NONE 

RIAL* 8  R(4),  V ( 4 ) ,  DaltaT,  Rl(4) f  Vi ( 4 ) 

-  Local*  - 

rkal*8  P, A, E, Inc, Omega, Argp, Nuo,M,Uo,Lo, CapPio, OmagaDot, 10, 


i  ArgpDot, MDot, UDot, LDot, CapPiDot, N,J2oP2, TvoPi, 

t  Small, J2,N8ar, Pi 

Characters  TypeOrbit 

*  -  Implementation  - 

TvoPi  =  6 . 28318530717959D0 
Pi  3  3 . 1415926535897900 

J2  =  0.0010826300 
Small  3  0.000001DO 


CALL  ELORB(  R, V,P, A, E, Inc, Omega, Argp, Nuo,H,Uo,Lo, CapPio) 
n  =  DSQRT ( 1 . ODO/A**3 ) 

-  Find  th#  valua  of  <12  parturbatlon* - 

J2oP2  =  (1.5D0*J2)  /  (p**2) 

KBar=  n*(  1.0DO  4  J2oP2»D8QRT(1.0D0-a*e)* 

&  (l.ODO  -  1.5D0*D8in(Inc)**2)  ) 

OmegaDot  =  -J2oP2  •  DCo*(inc)  *  mat 

ArgpDot  »  J2oP2  *  (2.0D0-2.5D0*DSin(inc)**2)  *  Nbar 

MDot  *  UBar 

KDot  3  -(4.0D0/3.0D0)  *  (1.0D0-E)  *  (NDot/Nbar)  Drag  Tarma 

-  Determine  typa  of  orbit  for  latar  u*a  - 

TypeOrbit3  'll* 

IF  (  E.LT. Small  )  THEM 

-  Circular  Equatorial  - 

IF  ((  Ino. LT. Small  ).or.(  DABS ( Inc-Pi ) .LT. Small  ))  THEN 
Typ*Orbit=  'CE' 

ELSE 

-  Circular  Incllnad  - 

TypeOrbit3  'Cl' 

ENDIF 

ELSE 

-  Elliptical,  Parabolic,  Hyparbollc  Equatorial  - 

IF  ((  Inc. LT. Small  ).or.(  ABS(Ino-Pl).LT. Small  ))  THEN 
TypeOrbit3  'EE' 

ENDIF 

ENDIF 

-  Updata  th*  orbital  alamant*  for  aach  orbit  typa  - 

-  Elliptical  -  Incllnad  - 

IF  (  TypaOrblt.aq. 'El'  )  THEN 

Omega  *  Omega  4  OaagaDot  *  DaltaT 
Omega  *  DMOC( Omega,  TvoPi) 

Argp  =  Argp  *  ArgpDot  *  DaltaT 

Argp  ■  DWOD( Argp,  TvoPi) 

M  =  M  4  MDOT  *  DaltaT 

M  *  DMOO(M,  TWOP1) 

CALL  NautonR(  e,m,  *0,Nuo  ) 

ENDIF 

-  Circular  -  Inclined  - 

IF  (  TypaOrblt.aq. 'Cl'  )  THEN 

Omega  =  Omega  +  OmegaDot  *  DaltaT 
Omega  3  DMOD( Omega,  TvoPi) 

UDot  =  ArgpDot  4  MDot 

Uo  *  Uo  4-  UDot  *  DaltaT 

Uo  *  DHODfUo,  TvoPi) 

ENDIF 

-  Elliptical  -  Equatorial  - 

IF  (  TypaOrblt.aq. 'BE'  )  THEN 

CapPiDot  3  OmegaDot  4  ArgpDot 

CapPio  3  CapPio  4  CapPiDot  *  DaltaT 

CapPio  =  DHOD(CapPio,  TvoPi) 

H  3  M  4  MDOT  *  DaltaT 

H  3  DHOD(M,  TvoPi ) 

CALL  NevtonR{  e,m,  e0,Nuo  ) 

ENDIP 

-  Circular  -  Equatorial  - 

IF  (  TypeOrbit. eq. 'CB'  )  THEN 

LDot  3  OmegaDot  4  ArgpDot  4  MDot 

Lo  3  LO  4  LDOt  *  DaltaT 

LO  3  DH0D(lO,  TVOPI) 

ENDIF 


-  U*e  RAXDV  to  find  nev  r  and  v  vector*  - 

CALL  RANDV(  P,E, Inc, Omega, Argp, Nuo,Uo,Lo, CapPio,  R1,V1  ) 
RETURN 
END 


*  C  68  ♦ 


SUBROUTINE  J2DRAGPERT 


* 

* 

* 


*  This  subroutine  calculates  the  perturbations  for  the  predict  problem 

*  involving  secular  rates  of  change  resulting  from  J2  and  Drag  only. 

* 


* 

Algorithm 

t  Find  tha  startup  valuas 

* 

Calculata  tha  dot  tariaa 

* 

Author 

t  Capt  Dava  Vallado  U8AFA/DFA8  719- 

472-4109  28  Ja 

* 

Inputs 

s 

* 

Inc 

-  Inclination 

red 

* 

e 

-  Eccantrlclty 

* 

N 

-  Naan  notion 

rad/TU 

* 

NDot 

-  Haan  Notion  rata 

rad  /  2TU2 

* 

Outputs 

t 

¥ 

OmegaDot 

-  Long  of  Asc  Nod.  rata 

rad  /  tu 

* 

ArgpDot 

-  Argument  of  parigaa  rata 

rad  /  TU 

* 

EDot 

-  Eccantrlclty  rata 

/  TU 

* 

Locals 

X 

* 

P 

-  Semi-paraoatar 

DU 

* 

A 

-  Sami-major  aria 

DU 

* 

Constants 

t 

* 

J2 

J2  zonal  harmonlo 

* 

Coupling 

1 

* 

Hons. 

* 

Refaranc.s 

1 

* 

Escobal 

pg.  369 

* 

O'Ke.fe  at 

al.(  Astronomical  J,  Vol  64  num  7,  pg. 

247  for  Edot 

* 


SUBROUTINE  J2DragPart  (  Inc,E,N,MDot,  Oa.gaDOT,ArgpDOT,EDOT  ) 
IMPLICIT  NONE 

REAL* 8  Inc,t,N,NDot,  OotagaDOT, ArgpDOT,EDOT 
REAL* 8  P,A,J2,NBar 

- - -  Impl.ia.ntat  ion  - 

J2  s  0.0010822800 

a  *  (1.000/n)  **  (2.0DO/3.0DO) 

p  3  a*(1.0DO  -  .**2) 

NBar=  n*(  l.OD0U.5D0*J2*(DSQRT(1.0D0-a*a)/(p»p)  )* 

(  <  l.0D0-1.5D0*DSln(lno)**2  )) 

-  Find  dot  Terms  - 

OmegaDot  =  -1.5O0*(  J2/{p*p)  )  »  DCo»(lnc)  *  NBar 
ArgpDot  *  l.SD0*(  J2/(p*p)  )  *  (2.0DO-2.5DO*D8ln(lnc)**2)  * 
s  Nbar 

EDot  =  -(4.QD0/3.0D0)  *  (1.0DO-E)  *  (NDOt/Nbar) 

RETURN 

END 


*  C-69  » 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

t 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

1 

* 

* 

* 

* 

* 


SUBROUTINE  PREDICT 


This  subrouting  determine*  the  azimuth  and  *1* vat ion  for  the  viewing 

of  a  staellite  from  a  known  ground  site.  Notice  the  Julian  Date  is  left 
in  it's  usual  DATS  foruit  since  the  dot  terms  are  input  as  radians  per 
day,  thus  no  extra  need  for  conversion.  The  Julian  Date  also  facilitates 
finding  the  site  position  vector.  Also  observe  RANDV  is  not  used  since 
this  would  merely  accomplish  extra  calculations.  The  Iteration  is  left 
out  to  allow  the  user  to  set  up  his  own  loop  to  look  for  sighting  times. 


Algorithm  t 

Author  >  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  30  Sep  1990 


Inputs 

JD 

JDEpoch 

No 

Ndot 

Eo 

Edot 

Inco 

Omegao 

OmegaDot 

Argpo 

ArgpDot 

Mo 

Lat 

Lon 

Alt 


i 

-  Julian  Date  of  desired  observation  Days 

-  Julian  date  of  epoch  for  satellite  Days 

-  Epoch  Mean  motion  rad/day 

-  Epcoh  Half  Mean  Motion  Rate  rad/2day2 

-  Epoch  Eccentricity 

-  Epoch  Eccentricity  rate  /day 

-  Epoch  Inclination  rad 

-  Epoch  Lon  of  Asc  node  rad 

-  Epoch  Lon  of  Asc  Node  rate  rad/day 

-  Epoch  Argument  of  perigee  rad 

-  Epoch  Argument  of  perigee  rate  rad/day 

-  Epoch  Mean  Anomaly  rad 

-  Geodetic  Latitude  of  site  rad 

-  Longitude  of  site  rad 

-  Altitude  of  site  DU 


Outputs 

Rho 

Az 

El 

Vis 

Locals 

Variable  o 

Dt 

A 

SO 

Nu 

LST 

GST 

Temp 

RtAsc 

Decl 

Theta 

Dist 

Small 

R 

R3 

VS 

RhoVec 

TempVec 

RHoV 

RSun 

C 

Constants 

Pi 

HalfPl 

TvoPl 

TUDay 

AUDU 

Coupling 

SUN 

HAG 

DOT 

CROSS 


-  Range  from  site  to  satellite 

-  Azimuth 

-  Elevation 


DU 

rad 

rad 


-  Visibility  Flag  'Radar  Sun', 'Radar  Nits' , 'Eye' , 'Not  Visible' 


-  denotes  the  epoch  value,  while  no  o  is  current 

-  Change  in  time  from  Epoch  to  desired  t  days 

-  Semi  major  axis 

-  Eccentric  Anomaly 

-  True  Anomaly 

-  Local  81dereal  Time 

-  Greenwich  Sidereal  Time 

-  Temporary  Real  value 

-  Suns  Right  ascension 

-  Suns  Declination 

-  Angle  between  IJK  Sun  and  Satellite  vecrad 

-  Ppdculr  distance  of  satellite  from  RSunDU 

-  Tolerance  of  small  values 

-  IJK  Satellite  vector 

-  IJK  Site  Vector 

-  Site  Velocity  vector 

-  Site  to  satellite  vector  in  ssz 

-  Temporary  vector 

-  Site  to  satellite  vector  in  IJK 

-  Sun  vector 

-  Temporary  Vector 


DU 

rad 

rad 

rad 

rad 

rad 

rad 


DU 

DU 

DU/TU 

DU 

DU 

AU 


Days  in  one  TU 
DUs  in  1  AU 


Position  vector  of  Sun 
Magnitude  of  a  vector 
Dot  product  of  two  vectors 
Cross  Product  of  two  vectors 


3.14159265358979 

1.57079632679490 

6.28318530717959 

0.00933809102919444 

23455.07 


ROTl,ROT2,ROT3  Rotations  about  1st,  2nd  and  3rd  axis 


SITE 
LST 1ms 
NewtonR 
LNCOH1 
References 
Escobal 


Site  Vector 
Local  Sidereal  Time 
Iterate  to  find  Eccentric  Anomaly 
Linear  combination  of  a  scalar  and  vector 
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*  070  * 


SUBROUTINE  Predict  {  JD , JDBpoch , no , Ndo t , Eo , Edot , 1 nco , Omeg a o , 

&  OmagaDot , Argpo , ArgpDot ,Ko , Lat ,  Lon , Alt , 

i  Rho,Ai,El,RtAsc,Dacl,Via  ) 

IMPLICIT  NONE 

REAL* 8  JD, JDBpoch, no, Ndot, So, Bdot, lnco,Oroegao,RtA*c,Decl, 

&  OmagaDot, Argpo, ArgpDot, Mo, Lat, Lon, Alt, Rho, As, El 

CHARACTER* 11  Via 
EXTERNAL  Dot 

-  Locala  - 

RBAL*8  Dt , a , EO , Nu , LST ,GST ,T**p,Th#ta , Diat , AUDU , 
i  Small,  Pi,  Half  Pi, TvoPi,  TUDay  ,N,M,E,0«iaga,  Argp, 

t  R(4) ,Rpqv(4) ,RS(4) ,V8(4) ,RhoVac(4) ,TampVtc(4) ,RhoV(4) , 

i  RSun( 4) ,C( 4) ,Dot 

INTEGER  l 


Implaaantatlon 


Small 

= 

O.OOOOOIDO 

Pi 

= 

3 . 141 59 26 535897 9D0 

HalfPl 

= 

1 ,5707  96  3267  94  90DO 

IwoPi 

= 

6 . 2831853071795900 

TUDay 

= 

0.009 33809102919444D0 

AUDU 

= 

23455. 07003DQ 

Kz 

= 

O.ODO 

El 

= 

O.ODO 

Rho 

= 

O.ODO 

— — 

-  Update  elementa  to 

Dt  » 

JD 

-  JDBpoch 

•  *  ao  +  EDot*Dt 

Omegas  Omegao  +  OmegaDot*Dt 
Argp  *  Argpo  +  ArgpDot*Dt 
H  *  HO  +  No*Dt  +  NDot*Dt*Dt 
M  »  DHOD(  K, TvoPi  ) 

N  a  NO  +  2 . 0D0*NDot*Dt 

N  =  N  *  TUDay 

-  Newton  Rhapaon  to  find  True  Anomaly  - 

CALL  NewtonR(  e,H,  E0,Nu  ) 

-  Form  PQW  poaition  vector  - 

a=  (  1.0D0/(N*N)  )  **  (  1.0D0/3.ODO  ) 

Rpqw(4)=  (  a*(i.0D0-a*a)  )  /  (1.0D0  +  e*DCoa(  Nu  )  ) 
Rpqv(l)=  Rpgw(4)*DCoa(  Nu  ) 

Rp(jw(2)*  Rpqw(4)*DSin(  Mu  ) 

Rpqv(3)=  O.ODO 


-  Rotate  to  IJK  — 

CALL  ROT3(  Rpqv  ,  -Argp  ,  Tamp Vac  ) 
CALL  ROTlj  TampVec,  -Inco  ,  TampVac  ) 
CALL  ROT3(  TampVec,  -Omega,  R  ) 


CALL  LSTIHEi  Lon.JD,  Lat, Gat  ) 
CALL  SITE(  Lat, Alt, Lat,  RS,VS  ) 


-  Find  IJK  rang*  vactor  from  alte  to  aatelllte 

DO  1=1,3 

RhoV(t)  =  R( 1 )  -  RS( i) 

ENDDO 

CALL  HAG(  RhoV  ) 

RhO=  RhoV ( 4 ) 


-  Calculate  Topocentric  Rt  atcenalon  and  declination 

Temp=  DSQRT(  RhoV(l)**2  +  RhoV(2)*»2  ) 

IF  (  DABS(  RhoV ( 2 )  ).LT. Small  )  THEN 
IF  (  Temp. LT. Small  )  THEN 
RtAsc=  999999.100 
ELSE 

IP  (  RhoV(l).GT. O.ODO  )  THEN 
RtAsc=  Pi 
ELSE 

RtAsc=  O.ODO 
EHDIP 
BID  IF 

ELSE 

RtASC  =  DATAN2(  RhoV( 2 )/Temp,  RhoV(l)/Tenp  ) 

END  IP 


IF  (  Temp. LT. Small  )  THEN 
Decl=  HalfPl 
ELSE 

Decl*  DAS IN (  RhoV( 3)/RhoV( 4)  ) 

END  IF 

-  Rotate  to  SBZ  - 

CALL  ROT3(  RhoV,  LST  ,  TempVec  ) 

CALL  ROT2{  TeopVec,Hal£Pi-Lat,  BhoVec  ) 


*  C-71  * 


-  Check  visibility  constraints  - 

-  I*  it  above  the  horizon  - 

IF  (  RhoVec(3) .GT. O.ODO)  THEN 

-  Is  the  site  in  the  light,  or  in  the  dark 

CALL  SUN(  JD,RSun, RtAsc, Decl  ) 

CALL  LnCOMl(  AUDU,RSun,  RSun  ) 

IF  {  DOT(  RSun.RS  ).GT. O.ODO  )  THEN 
Vis  =  'Radar  Sun  ' 

ELSE 

-  Is  the  satellite  in  the  shadow  or  not  — 

CALL  CROSS(  RSun,  R,  C  ) 

Theta=  '^ln<  C(4)/  (RSun(4)*R(4))  ) 

Dist  =  ; N  ;*DCOS(  Theta  -  HalfPl  ) 

IF  (  DlSt.GT.l.ODO  )  THEN 
Vis  =  'Eye  ' 

ELSE 

Vis  =  'Radar  Kite’ 

ENDIF 

ENDIF 

ELSE 

Vis  =  'Not  Visible' 

ENDIF 


-  Calculate  the  azimuth  and  elevation  - 

Temp-  DSQRT(  RhoVec(l)**2  +  RhoVec(2)**2  ) 

IF  (  DABS(  RhoVec(2)  ).LT. Small  )  THEN 
IP  (  Temp, LT. Small  )  THEN 
Az*  999999. IDO 
ELSE 

IF  (  RhoVec(l) .GT.O.ODG  )  THEN 
Az*  Pi 
ELSE 

As*  O.ODO 
ENDIF 
ENDIF 

ELSE 

Az  *  DATAN2(  RhoVec ( 2 ) /Temp , -RhoVec ( 1 ) /Temp  ) 

IP  (AS. LT. O.ODO)  THEN 
Az*  Tvopl+Aa 
ENDIF 
EHDIP 

IF  (  Temp. LT. Small  )  THEN 
B1  *  HalfPl 
ELSE 

El  *  DAS IN (  RhoVec ( 3 )/Rho  ) 

ENDIF 

-  Calculate  Geocentric  Rt  ascension  and  declination 

Temp*  DSQRT(  R(l)*»2  +  R(2)**2  ) 

IP  {  DADS!  R(2)  ).LT. Small  )  THEN 
IF  (  Temp. LT. Small  )  THEN 
RtAsc*  999999. IDO 
ELSE 

IP  (  R(1).QT. O.ODO  )  THEN 
RtAsc*  Pi 
ELSE 

RtAsc*  O.ODO 
ENDIF 
ENDIF 

ELSE 

RtAsc  *  DATAN2(  R(2)/Temp,  R(l)/Temp  ) 

ENDIF 

IP  (  Temp. LT. Small  )  THEN 
Decl*  HalfPl 
ELSE 

Decl*  DASIN(  R(3)/R(4)  ) 

ENDIF 

RETURN 

END 


*  c-72  * 


SUBROUT INI  DSRIV 


*  — 
* 


* 


* 

*  Thla  subroutine  calculates  the  derivative  of  the  state  vector  for  use  with 

*  the  Runge-Kutta  algorithm.  This  models  the  two-body  ROM. 

* 


Algorithm 

«  Rind  the  answer 

Author 

>  Capt  Dave  Vallado  USAFA/DFAS 

719-472-4109  6  Apr  1989 

Inputs 

t 

Time 

-  Time 

TU 

X 

-  State  vector 

DU,  DU/TU 

Outputs 

t 

XDot 

-  Derivative  of  8tate  Vector 

DU/TU,  DU/TU 2 

Locals 

X 

X4Cubed 

-  Cube  of  X(4) 

Constants 

I 

None, 

Coupling 

X 

None. 

References 

X 

None. 

SUBROUTINE  Derlv  (  Tlme.X,  XDot  ) 
IMPLICIT  NONE 
REAL* 8  Time,  X(6) ,  XDot(6) 

Real*8  X4Cubad 


-  Implementation  - 

X4Cubed»  (  D8QRT(  X<1)*»2  ♦  X(2)»*2  4-  X(3)»*2  )  )**3 


-  Velocity  Terms 

XDot(l)*  X ( 4 ) 

XDot(2)=  X ( 5 ) 

XDot(3)»  X ( 6 ) 


-  Acceleration  Terms 

XDot<4)»  -X(l)  /  X4Cubed 
XDot (5)*  -X(2)  /  X4Cubed 
XDot(6)=  -X(3)  /  X4Cubed 

RETURN 

END 


*  C-  73  • 


SUBROUTINE  PRRTACCEL 


Thl*  subroutine  calculates  the  actual  value  of  the  perturbing  acceleration. 

Algorithm  t  Setup  temporary  values 

Use  a  case  statement  to  select  which  perturbations  are  added 
Note  each  perturbation  adds  on  to  the  previous  result 

Author  i  Capt  Dave  Vallado  USAPA/DPA8  719-472-4109  20  Sep  1990 


Inputs 

R 

V 

Time 

WbichOne 

BC 


-  Radius  vector 

-  Velocity  vector 

-  Initial  time 

-  Which  perturbation  to  calculate 

-  Ballistic  Coefficient 


Outputs 

APert 


i 

-  Perturbing  acceleration 


Locals 

rs2 

rs3 

r«2 

r»3 

r32 

r33 

r34 

r2 

r3 

r4 

r5 

r7 

Beta 

Temp 

rho 

Va 

RSun 

RMoon 

RtAsc 

Decl 

1 


t 

-  Sun  radius  vector  **2 

-  Sun  radius  vector  **3 

-  Noon  radius  vector  **2 

-  Noon  radius  vector  **3 

-  "a*  component  of  Radlue  vector  **2 

-  *i*  component  of  Radius  vector  **3 

-  "a*  component  of  Radius  vector  *M 

-  Radius  vector  **2 

-  Radius  vector  **3 

-  Radius  vector  **4 

-  Radius  vector  **5 

-  Radius  vector  **7 

-  Temporary  Real  Value 

-  Atmospheric  Density 

-  Relative  Velocity  Vector 

-  Radius  Vector  to  Sun 

-  Radius  Vector  to  Noon 

-  Right  Ascension 

-  Declination 

-  Index 


DU 

DU/TU 

TU 

12345... 

kg/m2 


DU/TU2 


DU/TU 

AU 

DU 

deg 

deg 


Constants 

J2 

J3 

J4 

CMS 

GMN 

OmegaEarth 

TUDay 


t 


Sun  Gravitational  Parameter  DU3/TU2 
Noon  Cravltational  Parameter  DU3/TU2 
Angular  rotation  of  Barth  (Rad/TU) 
Days  In  one  TU 


0.00108263 

-0.00000254 

-0.00000161 

332952.9364 

0.01229997 

0.0588335906868878 

0.00933809102919444 


Coupling 

MAC 

Sun 

Moon 


Magnitude  of  a  vector 
Sun  vector 
Noon  vector 


References  t 
None. 


«■ 


r 


•l 


*  C-74  * 


SUBROUTINE  PartAccal  (  R,V,*i»#,NhlchOna,BC,  APart  ) 
IMPLICIT  NONE 

RKAL*8  R(4) ,V(4) /Tl««,AP*Et{4)/BC 
INTEGER  WhichOna 


REAL*8  j2,J3,J4,giu,gaa,OMgaE«rthiRtAsc,D«cI, 
i  ra2,rm2,r»3,r®3,r32,r33,r3«,r2,r3(r4,r5,r7,TUDay, 

i  Bata»Taap>rho,V*(4),R8ua{4)#RH0on(4) 

INTEGER  i 


* -  laplaaantatlon 

Oa*gaEarth=  0.0588335906861878800 
TUDay  =  0 . 0093380910291944  4D0 
CALL  MAG(  R  ) 

CALL  HAG(  V  ) 

R2  *  r(4)**2 
R3  *  R2*r(4) 

R4  =  R2*R2 
'  R5  «  R2*R3 
R7  =  R5*R2 
R32  »  r { 3 )*r ( 3 ) 

R33  «  R32*r( 3) 

R34  a  R32*R32 


*  -  J2  Accalaration  - 

IE  (  WhichOna. Bq.l  )  THEN 
32  «  0,0010826300 

APart(l)=  (  (-1.5*J2*r(l))  /  R5  )  *  (  1.0-(5.0*R32)  /  R2  ) 

APart(2)=  (  (-1.5*32*r(2))  /  B5  )  *  (  l.0-(5. 0**32)  /  *2  ) 

APart (3)*  (  (-1.5»32*r<3))  /  R5  )  M  3.0-(5.0*S32)  /  R2  ) 

CALL  MAG(  APart  ) 

ENDIP 

t  -  J3  Accalaration  - 

IF  (  WhichOna. Eq. 2  )  THEN 
J3  =  -0.0000025400 

APart (1)=  (  (-2.5*J3*r(l))  /  *7  )  *  (<3.0*r(3))-{7.0*R33) 

/  R2  ) 

APart(2)=  (  <-2.S*J3*r<2))  /  R7  )  *  ( (3.0*r(3) )-(7.0*R33) 

/  *2  ) 

IP  (DABS(  r ( 3)  ).gt.  0.0000001)  THEN 

APert(3)»  (  (-2.5*33*r<3))  /  R7  )  *  ((6.0*r{3))~ 

((3. 0**33)  /  R2)  -  ((3.0*r2)  /  r(3))) 

ELSE 

APert(3)=  O.0D0 
ENDIP 

CALL  HAG(  APart  ) 

ENDIP 

-  j4  accalaration  - 

IP  (  WhlChOna.Eq.3  )  THEN 
34  =  -0.0000016100 

APart(l)=  (  (-1.875*34»r(l)J  /  R7  )*(1.0-{ (14.0*R32)/R2)+ 

i  ((21.0*R34)  /  R4  )) 

APart ( 2)=  (  <-1.875*J4«r<2))  /  R7  )*(1.0-( (14.0*R32)/R2)+ 

t  ((21.0*R34)  /  R4  )) 

APart(3)=  (  (-1.875*J4*r(3))  /  R7  )*(5.0-((70.0*R32)/ 

t  (3.0*R2)  )+■(  (21.0*R34)  /  R4  )) 

CALL  HAG(  APart  ) 

ENDIP 


* 


*  C-75  * 


-  Sun  Acceleration  - 

IP  (  WhichOne.Eq.4  )  TtflM 
CHS  =  3.329529364D05 

Temp  =  Time*TUDay 
CALL  8UN(  Temp,  R8un,RtA*C,Decl  ) 

DO  1=  1,4 

RSun(i)1  Rflun(i) ‘23455. 07003D0 

END  DO 

RS2=  R8un{4)**2 
RS3=  R82*R8un(4) 

APert(l)=  (-Otf/BB3)  * 

i  (r(l?-3.0*R8un(l)* 

t  ((r(l)*RSun(l)+r{2)*RSun(2)+r(3)*RSun(3) )  /  RS2) ) 

APert(2)=  (-CHS/RS3)  * 

i  (r(2)~3.0*R8un(2)* 

6  ((r (l)*RSun(l)+r(2)*R8un(2)+r(3)*RSun(3) )  /R82)) 

APert(3)=  (-GNS/RS3)  * 

t  (r(3)-3.0*R8un(3)* 

t  <<r(l)*RSun(l)+r(2)*RSun(2)+r(3)*RSun(3))  /  R82)) 

CALL  J4AG(  APert  ) 

ENDIP 


-  Jtoon  Acceleration  - 

IP  (  WhichOne.lq.5  )  THIN 
GHM  =  0.01229997DO 

Temp  =  Tl»#»TUDey 

CALL  HOON(  Teap,  RMoon , RtAac , Decl  ) 

RM2=  RMoon(4)»*2 
RM3=  RM2*RMoon(4) 

APert(l)<=  (-CHM/RN3)  * 

t  (r(l)-3.0*RJ4oon(l)* 

t  ( (r(l)*RMoon(l)+r(l)*RHoon(l)+r(3)*RMoon{3)) 

*  /RM2)) 

APert (2)=  (-OM/RH3)  * 

(  (r(2)-3.0*RHoon(2)‘ 

t,  <(r(l)*RKoon(l)+r(2)*RMooa(2)+r(3)‘RHoon(3) ) 

t  /  R«2)) 

APert(3)=  (-CHM/RH3)  * 

t  (r(3)-3.0*RMoon{3)* 

t  ( (r(l)*RHoon(l)+r(3)*RJ4oon(3)4r(3)*RNoon(3) ) 

t  /  BM2 1 ) 

CALL  HAG(  APert  ) 

ENDIP 

-  Drag  Acceleration  - 

IP  (  WhlchOne.tq. 6  )  7HXN 

Va(l)=  V(l)  +  (0«ugaBarth*r(2)) 

Va(2)=  V(2 )  -  (Cx*egalarth*r (1)) 

Va(3)=  V(3) 

CALL  MAG(  Va  ) 

CALL  ATH0S(  R,  Rho  ) 

Temp=  -1000. 0D0  *  Va{4)  *  0.5D0*Rho*  |  l.ODO/BC  ) 
i  *  6378137. 0D0 

APert(i)=  Teep»va(l) 

APert(2)*  Tt»5*Va(2) 

APert(3)=  Teep‘Ve(3) 

CALL  MAG(  APert  ) 

ENDIP 


-  Solar  Acceleration  - 

IP  (  WhlchOne.Bq.7  )  THIN 
Temp  =  Tlme*TUDay 
CALL  3UN(  Teap,  RSun,RtAic,Decl  ) 

Beta  =  0.4D0 

APert(4)=  (4.74D~06*(1.0+Beta) )/(8C*9.807) 
APert(l)=  <-APert<4)*RSun(l))/RSun(4) 

APert (2)=  <-APert(4)*R8un(2))/RSun<4) 

APert (3)‘  (-APert(4)»R8un(3))/R8un(4) 
endip 

RETURN 

END 


*  C-V6  * 


★ 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

★ 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

★ 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


SUBROUTINE  PD3RIV 

This  subroutine  calculates  the  derivative  state  vector  for  the  RK4 

subroutine*  The  DerivType  string  is  used  to  determine  which  perturbation 
equations  are  used. 

Algorithm  i  Assign  values 

Check  each  value  of  Derivtype  and  if  a  perturbation  is  needed 
Author  i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  20  Sep  1990 

Inputs  t 

Time  -  Initial  time  TU 

X  -  initial  state  vector  DU  ,  DU/TU 

DerivType  -  String  for  including  YN  for  Perts  YNHYYYNNY 

BC  -  Ballistic  Coefficient  kg/m2 

Outputs  J 

XDot  -  Derivative  of  X  DU/TU  r  DU/TU2 

Locals  : 

RCubed  -  Radius  vector  cubed 

Ro  -  Radius  vector 

Vo  -  Velocity  vector 

APert  -  Perturbing  acceleration 

TempPert  -  Temporary  acceleration 

i  -  Index 

Constants  i 

None. 

Coupling  i 

FertAccel  Calculates  the  actual  values  of  each  perturbing  acceleration 
Addvec  Adds  two  vectors  together 

References  i 

None* 


DU3 

DU 

DU/TU 
DU/TU 2 
DU/TU 2 


* 


*  C-77  * 


SUBROUTINE  PDERIVf  Tima, X,DarivTypa,BC,  XDot  ) 
IMPLICIT  NONE 

REAL*8  X(6),XDot(6),Tlma,BC 
CHARACTER* 10  DarlvTypa 


*  -  Locals  - 

REAL* 8  RCubad, Ro{4),Vo(4),APartf 4), TanpPart(4) 
INTEGER  1 

*  -  Implamantatlon  - - — 

DO  1=  1,  3 

APert(l)=  0.0D0 
Ro(i)  =  X<1) 

Vo(l)  =  X( 1+3) 

END  DO 

CALL  MAG(  RO  ) 

CALL  MAG(  VO  ) 

APart(4)=  0.0D0 
RCubad  =  RO(4)**3 

*  -  Valocity  Tarns  - 

XD0t(l)=  X<4) 

XDot(2}=  X { 5 ) 

XDOt(3)=  X ( 6 ) 


*  -  Accalaratlon  Tarns  - 

IF  (  DarlvTypa(lil) .aq. 'T'  )  THEN 

CALL  PartAccal(  Ro,Vo,Tli»a,l,BC,  APart  ) 
ENDIF 

IF  (  DerivTypa(li2) .aq. ‘Y1  )  THEN 

CALL  PartAccal(  Ro,Vo,Tlna,2,BC,  TanpPart  ) 
CALL  Add Vac <  TanpPart, APart, APart  ) 

ENDIF 

IF  (  DarivTypafltS) .aq. 'I'  )  THEN 

CALL  PartAccalf  Ro,Vo,Ti*a,3,BC,  TanpPart  ) 
CALL  AddVac(  TanpPart i APart, APart  ) 

ENDIF 

IF  (  DarlvTypa(lt4) .aq. 'Y1  )  THEN 

CALL  PartAccalf  Ro,Vo,Tiaa,4,BC,  TanpPart  ) 
CALL  AddVacf  TanpPart, APart,APart  ) 

ENDIF 

IF  (  DarivTypafliS) .aq. * Y *  )  THEN 

CALL  PartAccalf  Ro,Vo,Tlna,5,BC,  TaapPart  ) 
CALL  AddVacf  TanpPart, APart,APart  ) 

ENDIF 

IF  (  DarlvTypa(li£) .aq. ’Y'  )  THEN 

CALL  PartAccalf  Ho, Vo, Tina, 6 ,8C,  TanpPart  ) 
CALL  AddVacf  TanpPart, APart,APart  ) 

ENDIF 

IF  (  DarlvTypa(l>7) .aq. 'Y'  )  THEN 

CALL  PartAccalf  Ro,Vo,Tlma,7,BC,  TanpPart  ) 
CALL  AddVacf  TanpPart, APart, APart  ) 

ENDIF 

XDot(4)=  (-X(l)  /  RCubad)  ♦  APartfl) 

XDot(5)=  ( —X ( 2 >  /  RCubad)  +  APart(2) 

XDot(6)=  f-X(3)  /  RCubad)  +  APert(3) 

RETURN 

END 


*  C-78  * 


SUBROUTINE  AK4 


This  subroutine  Is  a  fourth  ordsr  Runge-Kutta  lntsgrator  for  an 

N-dlmenslonal  First  Ordsr  dlffsrsntlal  aquation.  Ths  ussr  Bust  provlds 
an  external  subroutlns  containing  tbs  system  Equations  of  Motion.  Notice 
time  Is  Included  sines  sons  applications  may  need  this.  Ths  LAST  position 
In  DerivType  Is  a  flag  for  two-body  action,  Two-Body  action  la  used  If 
the  10th  element  Is  set  to  ‘21,  otherwise  the  Tea  and  No  values  determine 
which  perturbations  to  use. 

Algorithm  :  Evaluate  each  term  depending  on  the  derlvtype 
Find  the  final  answer 

Author  i  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  20  8ep  1990 


Inputs 

ITlme 

s 

Initial  Tima 

TU 

DT 

- 

Step  slse 

TU 

N 

- 

Dimension  of  the  state 

DerlvType 

- 

String  for  including  TN  for  Farts 

TNNmHNY2 

BC 

- 

Ballistic  Coefficient 

kg/m2 

X 

- 

State  vector  at  Initial  time 

DU,  DU/TU 

Outputs 

X 

1 

State  vector  at  new  time 

DU,  DU/TU 

Locals 

XDot 

t 

Derivative  of  State  Vector 

DU/TU,  DU/TU2 

Time 

- 

Time 

TU 

K 

- 

Storage 

TEMP 

- 

Storage 

J 

- 

Index 

TempTlme 

- 

Temporary  time  storage 

TU 

Constants  i 
None. 


Coupling  i 

Derlv  Subroutine  for  Derivatives  of  B.O.M.  for  Two-Body  problem 

PDerlv  Subroutine  for  Perturbed  E.O.M. 

References  i 

James,  at  al.,  ‘Applied  Numerical  Methods*  pg.  461-466,  sqtn  pg.  463. 
BMW  pg.  414-415 


*  C-79  * 


SUBROUTINE  RK4  (  ITlme,DT,N,D*rivTyp*,BC,  X  ) 
IMPLICIT  NONE 
INTEGER  N 

REAL* 8  DT,  ITiM,  X(N) ,  BC 
CHARACTBR*10  DerivTypt 


-  Local*  - 

REAL* 8  XDot(fi),  K(6>3) ,  TSHP(6) ,  TltM,  TempTime 
INTEGER  J 


-  Iraplenentation  - 

TerapTiM  »  ITiM 
IF  (DerivTypeiljlOJ.eg.^')  THEN 
CALL  DERIV(  ITiM,X,XDot  ) 

ELSE 

CALL  PDERIV(  ITlM,X,D*rlvTyp*,BC,XDot  ) 
BNDIP 


-  Evaluate  lat  Taylor  Stria*  Term  — 

DO  J  =  1/N 

K(J,1)  =  Dt  *  XDOt(J) 

TBMP(J)  =  X(J)  ♦  O.5D0*K(J,l) 

ENDDO 

Tint  a  ITimt  -I-  Dt/2.0D0 

IF  (DtrlvTypt(ltlO)  .#<3.  '2' )  THEN 
CALL  DERIV(  TiM,T*l*p,XDOt  ) 

ELSE 

CALL  PDSRIV(  TiM,T*ap,D*rlvType,BC,XDot  ) 
ENDIF 


-  Evaluate  2nd  Taylor  Ser is*  Terra  — 

DO  J  =  1,N 

K(J, 2)  =  Dt  »  XDot(J) 

TEMP(J)  =  X(J)  +  0.5D0*K(J,2) 

ENDDO 

IF  (DerlvType(lilO) .eg. '2' )  THEN 
CALL  DERIV(  Tln*,T*«p,XDot  ) 

ELSE 

CALL  PDERIVf  Tlraa,Teap,Der ivType,BC,XDot  ) 
ENDIF 


-  Evaluate  3rd  Taylor  Stria*  Terra  - 

DO  J  =  1,N 

K ( J , 3 )  a  Dt  *  XDOt(J) 

TEMP(J)  =  X(J)  +  K(J,3) 

ENDDO 

TempTime  =  TtmpTirae  +  Dt 

IF  (DerivTypt(lilO) •eg. *2’ )  THEN 
CALL  DERIV(  T*mpTioe,T*rap,XDot  ) 

ELSE 

CALL  PDERIV(  TempTime, Tsmp/D*rlvTyp*,BC,XDOt  ) 
ENDIF 


-  Update  the  *tate  tector  - 

DO  J  =  1,N 

X(J)  =  X(J)  +  (  K(J,1)  +  2 . ODO* (K(J, 2)  +  K(J| 3) )  + 
(  Dt*XDot ( J)  )  /  6. ODO 

ENDDO 

RETURN 

END 


*  C-80  • 


SUBROUTINE  ATMOS 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

# 

* 

* 

* 

» 

* 

* 

* 

* 

* 

* 


This  subroutine  finds  the  atmospheric  density  at  an  altitude  above  an 
oblate  earth  given  the  position  vector  in  the  Geocentric  Equatorial 
frame.  The  position  vector  is  in  DU's  and  the  density  is  in  ga/cm**3. 


Algorithm  i  Find  initial  values 

toop  to  find  the  latitudes 

Calculate  the  density  through  a  cascading  IP  statement 
Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


Inputs 

R 


» 

-  GEC  Position  vector 


DU 


Outputs 

Rho 


I 

-  Density 


go/cm* *3 


Locals  i 

Rc 

Height 

Alt 

OldDelta 
DeltaLat 
GeoDtLat 
GeoCnLat 
TvoFMlnusF2  - 
OneMlnusF2  - 
Delta 
Temp 
RSqrd 
SlnTemp 
RhoNom 
H 
1 


Range  of  site  w.r.t.  earth  center 
Height  above  earth  w.r.t.  site 
Altitude  above  earth  w.r.t.  site 
Previous  value  of  DeltaLat 
Dlff  between  Delta  and  Geocentric  let 
Geodetic  Latitude 
Geocentric  Latitude 
2*F  -  F  squared 
(  1  -  F  )  squared 

Declination  angle  of  R  in  IJK  system 
Dlff  between  Geocentric/Ceodetlc  lat 
Magnitude  squared 
Sine  of  Temp 

Nominal  density  at  particular  alt 

Scale  Height 

index 


DU 

DU 

ka 

rad 

rad 

-Pi/2  to  Pi/2  rad 
-Pi/2  to  Pi/2  rad 


rad 

rad 

DU2 

rad 

ga/ca**3 

ka 


Constants  i 

Pi 

Flat  -  Flatennlng  of  the  Earth 

RBarthKm  -  Radius  of  Earth  in  ka 


3.14159265358979 

0.003352810664747352 

6378.137 


Coupling 

MAG 


Magnitude  of  a  vector 


References 

Escobal 

Blltzer 

Herts 


pg.  398-399  (  Conversion  to  Lat  and  Height  ) 
pg.  63  (  Atmospheric  density  ) 
pg.  820  (  Low  altitude  density  ) 


*  C-81  * 


SUBROUTINE  ATMOS  (  R,  Rho  ) 
IMPLICIT  MONK 
RBAL+8  R(4),  Rho 


-  Local!  - 

REAL*8  Rc,  Haight ,  OldDalta,  DaltaLat,  GaoDtLat, 
t  TwoFMlnuaP2,0naMinusP2,  Dalta,  RSqrd,  Tamp,  Pi,  Plat, 

i  GaoCnLat,H,  Rhonom,  Alt,  RBarthka,  SinTarap 

INTEGER  i 


-  InitlalUa  valua*  - 

PI  =  3. 1415926 535897 9D0 
CALL  MAG(  R  ) 

Plat  =  0.003 35281066 4747 352D0 
TwoFMlnuaF2  *  2.0D0*»lat  -  PI at**2 
OnaMlnu*P2  =  (  l.ODO-Plat  )**2 
RBarthKm  =  6378.13700 

-  Sat  up  initial  latltuda  valua  - 

Dalta  =  DATan{  R(3)  /  D8QRT(  R(1)*R(1)  +  R( 2 )*R( 2 )  )  ) 

IP  (  DABS (Dalta). GT. Pi  )  THEN 
Dalta  =  DMOD(  Dalta, Pi  ) 

ENDIF 

GaoCnLat  =  Dalta 
OldDalta  =  1.0D0 

DaltaLat  =  10.0DO 
RSqrd  =  R(4)**2 

—  Itarata  to  find  Gaocantrlc  and  Gaodatio  Latltuda  - 

1  =  1 

DO  WHILE  (  (  DABS(OldDalta-DaltaLat) .OT.0.00001D0) .and. 
(1.LT.10)  ) 

OldDalta  s  DaltaLat 

RC  =  D3QRT(  (  1 . 0D0-TvoPMinu*P2  )  / 

(  1 . 0D0-TvoPNinuiF2*DC08( GaoCnLat )  **2  )  ) 
GaoDtLat  =  DATant  DTAN(GaoCnLat)  /  OnaMinuaP2  ) 

Tamp  *  GaoOtLat-GaoCnLat 
SlnTemp  *  DSIN(  Taaqp  ) 

Haight  =  D8QRT(  RSqrd  -  (Rc**2)+81nTaap*+2  )  - 
Rc*DCOS(Taap) 

DaltaLat  =  DA8IN(  Haight*SinTamp  /  R(4)  ) 

GaoCnLat  *  Dalta  -  DaltaLat 
1=1  +  1 
BNDDO 

IP  (  1.GK.10  )  THEN 

Wrlta(*,*j  'ATMOS  latltuda  Itaration  did  MOT  convarga  ' 
ENDIF 


* 


i 


4 


4 


*  (j-82  * 


ALT  =  Height*RBarthKni 


-  Determine  Density  based  on  altitude  - 

IF(ALT.Gi.SuODO)  THBN 
H  =  130. SDO 
RHONOM  ■  4.262D-17 

BHO  =  RHONOH*DBXF(  (800.0DQ-ALT)/H) 

BLSBIF(AI.T.GB.700D0)  THBH 
H  *  10S.3DO 
RHONOM  =  1 . 216D-16 

RHO  =  RHONOM*PE!IP{  (700.0D0-ALT)/H) 
BL8BIF(ALT.GE.600d0)  THBN 
H  =  91.0D0 

RHONOM  =  3.818D-16 

RHO  =  RHONOM*DEXP(((OO.ODO-ALT)/H) 

EL8BIF(ALT.GE.500DO)  THBH 
K  =  31.5D0 
RHONOM  =  X.3I6D-X3 
RHO  =  RHONOM*DBXP((500.0D0-ALT)/H) 
EL3IIF(ALT.GE.400D0)  THBN 
H  =  73.2D0 
RHONOM  =  5.X92D-X5 

RHO  =  RHONOH*DBXP( (400.0D0-ALT)/H) 

EL8EIF ( ALT . GB . 300D0 )  THBN 
H  =  61.2D0 
RHONOM  -  2.653D-14 

RHO  *  RHONOM*  DEXF(  (300. 0D0-AI>T)/H) 

ELSEIP( ALT.GE.250D0)  THBN 
K  *  52. (DO 
RHOHOM  *  7.316D-X4 

RHO  *  RHOMOM*DBXP( (250.0D0-ALTJ/H) 

EL3EIF (ALT.GB.200D0)  THBN 
H  *  40. IDO 

RHONOM  «  2.706D-X3 

RHO  a  RHONOM*DBXP( (200.0D0-ALT)/H) 

BLSBXF(AIiT.GB.X50D0)  THEN 
H  *  24. IDO 

RHONOM  a  2.14XD-12 
RHO  «  RHONON*DKX?((X50.0D0-ALT)/H) 

BLSBIF(ALT.GB.X30DO)  THBN 
H  ■  IS. IDO 
RHONOM  ■  8.484D-12 

RHO  a  RHONOM*DEXP( (X30.0D0-ALT)/H) 
ELSE 

H  «  8.06D0 

RHONOM  «  9.661D-X1 

RHO  a  RHONOM*DBXP ( ( X  XO . 0 DO-ALT ) /H ) 
BNDXF 


RETURN 

END 


*  C-83  * 


SUBROUTINE  CHEBY 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

ft 

* 

* 

ft 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

ft 

* 


Thi3  subroutine  calculates  a  CHBBYCHEV  expansion  for  the  atmosphere. 

Given  an  altitude  above  the  Earth's  surface,  it  will  find  the  pressure  and 
density  at  that  altitude  using  a  Chebyahev  polynomial.  Calculations  are 
accomplished  in  metric  units,  and  the  final  answers  are  converted  to 
English  units,  as  described  below. 

The  model  is  only  valid  from  0  to  200  km  (656,000  ft)  altitude. 

Algorithm  :  Convert  the  altitude  to  km 

Assign  the  pressure  coeff  based  on  altitude 
Calculate  the  pressure 

Assign  the  density  coeff  based  on  altitude 
Calculate  the  denlsty 
Convert  to  ENGLISH  units 


Author 

:  C2C  Gandhi  USAFA 

Capt  Dave  Vsilado  USAFA/DFAS 

719-172-4109  23  Nov 

715-472-4109  28  Aug 

1983 

1990 

Inputs 

Alt 

! 

-  Altitude  above  earth's  surface, 

ft 

Outputs 

PAlt 

RhoAlt 

i 

-  Pressure  at  altitude 

-  Density  at  altitude 

lbf/in**2 
lbra/f t**3 

Locals  : 


Constants  : 

None. 

Coupling  : 

None. 

References  i 

None. 


SUBROUTINE  CHEBY  (  ALT,  PALT , RHOALT  ) 
IMPLICIT  NONE 
REAL*8  Alt ,PAlt ,RhoAlt 


REAL* 8  2,  21,  Sum,  P0  ,  X,  Nu,  Part,  LnR,  R,  RhoO,  C(15),A(15) 
INTEGER  k 


«  -  Convert  altitude  to  kilometers 

2  =  Alt  *  O.OOO3O40DO 

t 


*  C-84  * 


338 


6AAVI 


* 


4 


IF  (Z.le.80.0D0)  THEN 

-  Chebychev  model  for  altitudes  of  80  ka  or  less  — 

-  Define  initial  and  aero  altitude  pressure  constants 


* 


SUM  =  0.0D0 

Z1  =  80.0D0 

P0  =  101325. 0D0 

-  Define  the  pressure  ratio  coefficients 

A(l)  =  -11. 385925D0 
A{2)  =  -5.6837011D0 

A(3)  =  0.052666476D0 

A(4)  =  -O.077884294D0 

A{5)  =  -0 . 11004063DO 

A ( 6 )  =  0.017572339DO 

A(7)  =  0.0048546337DO 

A  ( 8 )  =  0.0017694805DQ 

A ( 9 )  =  -0.0018185298D0 

A( 10 )  -  ~0 . 0026635086D0 

A ( 1 1 )  =  0 . 0035685433DO 

A(12)  =  -0.00082257517D0 

A<  13)  =  -0.0010363683DO 

A ( 1 4 )  =  0.00057053477DO 

A(15)  =  -0.00019023076D0 

ELSE 


-  Chebychev  model  for  altitudes  of  80  to  200  km  — 

Define  initial  and  aero  altitude  pressure  constants 
SUM  *  0.0D0 

21  *  2G0.0D0 

P0  =  101325. 0D0 


-  Define  the  pressure  ratio  coefficients 

A(l)  *  -24.475069D0 
A(2)  ■  -1O.685I61D0 

A  ( 3 )  *  2 . 2622605D0 

A(4)  =  O.63433398D0 

A ( 5 )  *  -0.27948959D0 

A { 6 )  =  -O.31548S74D0 

A ( 7 )  =  0.090751361DO 

A ( 0 )  =  0.18530467DO 

A( 9 )  =  -O.09532SB43D0 

A ( 1 0 )  =  -0.050214309DQ 
A  ( 1 1 )  =  O.045101378D0 

A( 12 )  -  0.00889.  7472D0 
A ( 1 3 )  -  -0.018935899DO 
A(  14 )  =  0.0035690621D0 
A(1S)  *  -0.0063989880DO 
EKDIP 


-  Define  X  as  a  function  of  the  altitude  ratio  - - — 

X  =  2.QD0  •  Z/Zl  -  l.ODO 

- - — - - Define  Nu  as  a  function  of  X - - - 

Nu  3  2.0D0  *  X 

-  Define  cho  Chebyshev  Polynomials  as  functions  of  Nu  - 

C( 2)  »  NU 

C(3)  =  NU*NU  -  2.0DO 

DO  k  =  4,15 

C(k)  =  Nu  *  C(k-l)  -  C<k-2) 

END  DO 

—  Sum  all  parts  of  the  Chebyshev  expansion  atmospheric  model — 
DO  k=  2,15 

PART  =  A ( k )  *  C ( k ) 

SUM  a  SUM  +  PART 
ENDDO 


-  Solve  for  the  pressure  at  altitude  - 

LNR  =  0.5D0  *  ( A(  1 )  3UM) 

R  =  OEXP(LNR) 

PALT  =  R  »  P0 


% 


IF  (Z.le.80.0D0)  THKN 

-  Chebychev  Modal  for  altltudaa  of  80  km  or  less  - 

-  Defina  Initial  and  aero  altitude  density  constants  - 


SUM 

= 

O.ODO 

Z1 

= 

80.0DO 

RHOO 

= 

1.2250D0 

— 

-  Define  the  density  ratio  coefficients 

A  ( 1 ) 

= 

-10.960632D0 

A(2) 

= 

-5.5717132D0 

A(3) 

= 

0 . 099116555D0 

A(4) 

= 

0.061044847DO 

A<5) 

= 

-0.14304157D0 

A(6) 

= 

0.0029494088DO 

A(7 ) 

= 

0.0058789604DO 

A  ( 8 ) 

= 

0.0020421324DO 

A(9) 

= 

0.0071033206DC 

A(  10) 

= 

-0.0010314D86D0 

A  ( 1 1 ) 

= 

0.0034100737DO 

A(  12 ) 

s 

0.0041764325D0 

A(13) 

- 

-0.0039151559D0 

A  ( 14 ) 

= 

0.0011227828D0 

A(  IS ) 

z 

-0.001S751053DO 

ELSE 


-  Define  Initial  and  aaro  altitude  density  constants  - 

SUM  =  0.0D0 
Z1  =  200. 0D0 
RHOO  =  1.2250D0 

-  Chebychev  modal  for  altitudes  of  80  to  200  km  - 

- -  Define  the  density  ratio  coefficients  - 

A( 1 )  =  -25.415229D0 

A(  2 )  =  -11.684380DO 

A(3)  =  1 . 872140SD0 

A(  4 )  =  0.81660876D0 

A(5)  *  -0.093811118D0 

A ( 6  )  =  -0.3015573SD0 

A(7)  =  -0 . 077593291DO 

A ( 8  )  *  0.21640168D0 

A  ( 9 )  =  -0.034918422DO 

A(  10 )  =  -0.070126799D0 
A  { 11 )  =  0.036014616D0 
A(12)  =  Q.014951351DO 

A(13)  =  -O.O214S0283DO 
A(l4)  =  -O.O012497995D0 
A  { 1 5 )  =  0. 018421866D0 

END  IF 

-  Define  X  as  a  function  of  the  altitude  ratio  - 

X  *  2.0D0  *  Z/Zl  -  1.0DO 

-  Define  Nu  as  a  function  of  X  - 

Nu  =  2.0D0  »  X 

-  Define  the  Chebyshev  Polynomials  as  functions  of  Nu  - 

C(2)  =  Nu 

C (  3 )  =  Nu*Nu  -  2.0D0 

DO  k=4,15 

C ( k )  =  Nu  *  C(k-l)  -  C(k— 2 ) 

ENDDO 

-  Sum  all  parts  of  the  Chebyshev  expansion  atmospheric  model  — 

DO  k=  2,15 

PART  =  A(k>  *  C<k) 

SUM  =  SUH  +  PART 
ENDDO 

-  Solve  for  the  density  at  altitude  - 

-  0.5D0  *  ( A ( 1 )  ♦  SUM) 

R  =  DBXP(LNR) 

RHOALT  =  R  *  RHOO 

—  Convert  pressure  &  density  from  metric  units  to  English  units — 

(N/(m*m)  *=>  lbf/ln**2  kg/m**3  ==>  lbm/ft**3)  - 

PAlt  =  PAlt  *  O.OO0145DO 
RhoAlt  =  RhoAlt  *  0.062429507D0 

RETURN 

END 


APPENDIX  D 


FORTRAN  SOURCE  CODE 


MATHEMATICAL  ROUTINES 


Moduli  -  HATH. FOR 


This  file  contains  fundamental  mathematical  Subroutines  and  functions. 

*****************  NOTICE  OF  GOVERNMENT  ORIGIN  **************** 

This  software  has  been  developed  by  an  employee  of  the  United  States 
Government  at  the  United  States  Air  Force  Academy,  and  Is  therefore 
a  work  of  the  United  States,  and  is  NOT  subject  to  copyright  protection 
under  the  provisions  of  17  U.S.C.  10S.  ANY  use  of  this  work,  or 
inclusion  in  other  works,  must  comply  with  the  notice  provisions  of 
17  U.S.C.  403. 

**************************************************************** 

Author  i  Cspt  Dave  Vallado,  USAFA  Dept  of  Astronautics 

Coml  719-472-4109,  Autovon  259-4109  /  4110 

Current  t  30  Jan  91  Capt  Dave  Vallado  VERSION  3.0 

Changes  i  25  Jan  91  Capt  Dave  Vallado 

Upgrade  to  LAHEY  Ver  3.0  /  FORTRAN  90 
20  Sep  90  Capt  Dave  Vallado  VERSION  2.1 

Mlac  fixes  to  speed  up 

20  Apr  90  Capt  Dave  Vallado  VERSION  2.0 

14  Nov  69  Capt  Dave  Vallado 

24  Apr  89  Capt  Dave  Vallado 
Version  1.2 

12  Feb  88  Capt  Dave  Vallado 

Standardized  Format 
6  Sep  88  Capt  Dave  VallAdo 

Added  Determinant  and  others 
30  Aug  88  Capt  Dave  Vallado 
Version  1.0 


CONTENTS i 


Mlsc  Functions 


Function 

Cot 

(  XVal 

) 

Function 

Csc 

{  XVal 

> 

Function 

Sec 

(  XVal 

) 

Function 

DACOSH 

<  XVal 

) 

Vector  Operations 


Function 

DOT 

(  Vecl,Vec2 

Subroutine 
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FUNCTION  COT 


This  Function  finds  the  Cotangent  of  an  angle  in  radians. 


Algorithm  i  Find  the  tangent  of  the  angle 

Check  to  avoid  a  divide  by  zero 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


Inputs 

XVal 


i 

-  Angle  to  take  Cotangent  of 


Outputs 

Cot 


i 

-  Result 


rad 


Locals 

Temp 

Infinity 

Coupling 

None. 


i 

-  Temporary  Real  variable 

-  Large  value  to  represent  infinity 

> 


REAL* 8  FUNCTION  Cot(  XVal  ) 
IMPLICIT  NONE 
REAL* 8  XVal 


-  Locals 

REAL* 8  Temp, Inf lnlty 


-  Implementation  ■ 

Infinity  =  999999. 9D0 
Temp  =  DTAN(  XVal  ) 

IF  (  DABS (Temp) .LE.0.000001D0  )  THEN 
Cot  =  Infinity 
ELSE 

Cot  =  l.ODO  /  Temp 
ENDir 


RETURN 

END 


FUNCTION  CSC 


*  This  Function  finds  the  Cosecant  of  an  angle  in  radians. 

* 

*  Algorithm  :  Find  ths  sins  of  ths  angle 

*  Chock  to  avoid  a  divide  by  aero 

* 


* 

* 

Author 

:  Capt  Dave  Vallado  USAPA/DFAS  719-472-4109 

* 

Inputs 

: 

* 

* 

XVal 

-  Angle  to  take  Cosecant  of 

* 

Outputs 

i 

* 

ft 

Csc 

-  Result 

* 

Locals 

• 

* 

Temp 

-  Temporary  Real  variable 

* 

Infinity 

-  Large  value  to  represent  infinity 

* 


*  Coupling  i 

*  None . 

* 


20  Sep  1990 
rad 


REAL* 8  FUNCTION  Csc(  XVal  ) 

IMPLICIT  NONE 
REAL* 8  XVal 

-  Locals  - 

REAL* 8  Tamp, Inf lnlty 

-  Implementation  ■ 

Infinity  =  999999. 9D0 
Temp  =  DSIN(  XVal  ) 

IF  (  DABS(Tamp) .LK.O.OOOOOIDO  )  THEN 
Csc  =  Infinity 
ELSE 

Csc  -  1.0D0  /  Tamp 
END  IF 

RETURN 

END 


FUNCTION  SEC 


This  Function  finds  the  secant  of  an  angle  in  radians. 


Algorithm  i  Find  the  cosine  of  the  angle 

Check  to  avoid  a  divide  by  zero 

Author  i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  20  Sep  1990 


Inputs 

i 

XVal 

-  Angle  to  take  secant  of 

Outputs 

i 

Sec 

-  Result 

Locals 

i 

Temp 

-  Temporary  Real  variable 

Infinity 

-  Large  value  to  represent  Infinity 

Coupling  t 

None. 


rad 


REAMS  FUNCTION  Sec(  XVal  ) 
IMPLICIT  NONE 
REAL* 8  XVal 


-  Locals 

REAL* 8  Temp, Infinity 


-  implementation  ■ 

Infinity  *  999999. 9D0 
Temp  =  dcos(  xval  ) 

IF  (  DABS ( Temp ).LE.0.C00001D0  )  THEN 
Sec  =  Infinity 
ELSE 

Sec  3  1.0D0  /  Ten® 

END  IF 

RETURN 

END 


FUNCTION  DACOSH 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  function  evaluates  the  Invars*  hyperbolic  cosine  function. 

Algorithm  i  cheek  for  an  undefined  value 

Calculate  the  answer  using  LOG  base  10 

Author  t  Capt  Dave  Vallado  USAPA/DFAS  719-472-4109  28  Mar  1990 


Inputs  : 

XVal  -  Value 

Outputs  I 

DACosh  -  Result 


Locals 

Temp 

Undefined 

Coupling 

None. 


Temporary  Real  Value 

Flag  value  for  an  undefined  quantity 


1.0  to  Infinity 


any  real 


REAL* 6  FUNCTION  DAC08H(  XVal  ) 
IMPLICIT  NONE 
REAL* 8  XVal 


-  Locals 

REAL'S  Temp.UnDef ined 


-  Implementation  - 

Undefined^  999999. 1D0 

IF  ( XVal** 2-1. ODO.LT.O.ODO)  THEN 
Temp:  Undefined 

Wrlte(*,*)  'Error  in  ArcCosh  Function  ' 

ELSE 

Temp*  DLOG(  XVal  +  D8QRT(  XVal*XVal  -  l.ODO  )  ) 
ENDIF 

DACOSH  *  Temp 

RETURN 

END 


FUNCTION  DOT 

This  Function  finds  the  dot  product  of  two  vectors. 

Algorithm  i  Calculate  the  answer  directly 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 


Inputs 

Vecl 

Vec2 


-  Vector  number  1 

-  Vector  number  2 


Outputs 

Dot 


-  Result 


Locals 

None. 

Coupling 

None. 


REAL* 8  FUNCTION  DOT(  Vecl,Vec2  ) 
IMPLICIT  NONE 
REAL* 8  Vecl(4) ,Vec2(4) 


- - -  Implementation  - 

DOT®  Vecl(l)*Vec2(l)  +  Vecl(2)*V#c2(2)  +  Vecl(3)*Vec2(3) 

RETURN 

END 


SUBROUTINE  CROSS 

This  Subroutine  crosses  two  vectors. 

Algorithm  i  Calculate  each  vector  component 
Find  the  magnitude  of  the  answer 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 


Inputs 

Vecl 

Vec2 


-  Vector  number  1 

-  Vector  number  2 


Outputs 

OutVec 


Vector  result  of  A  x  B 


Locals 

None. 

Coupling 

MAG 


-  Magnitude  of  a  vector 


SUBROUTINE  CROSS!  Vecl,Vec2,  OutVec  ) 
IMPLICIT  NONE 

REAL* 8  Vecl(4)>  Vec2(4)i  OutVec(4) 


-  Implementation  - 

OutVec(l)®  Vecl(2)*Vec2(3)  -  Vecl(3)*Vec2(2) 
0utVec(2)=  Vecl(3)»Vec2(l)  -  Vecl(l)*Vac2(3) 
0utVec(3)=  Vecl(l)»Vec2(2)  -  Vecl(2)*Vec2{l) 
CALL  MAG(  OutVec  ) 


RETURN 

END 


* 


SUBROUTINE  HAG 


* 

* 

* 

* 

* 

* 

4 

* 

★ 

* 

★ 

* 

* 

* 

* 

* 

* 

★ 

* 

* 

4 

4 


This  Subroutine  finds  the  magnitude  of  a  vector.  the  tolerance  la  set 
for  0.000001,  thus  the  1.0D-12  for  a  squared  test  of  underflows. 

Algorithm  t  Find  the  squared  sum  of  the  terms 

Check  to  be  sure  there  is  no  8QRT  of  0.0 

Author  s  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 


Inputs 

Vec 


i 

-  Vector 


Outputs 

Vec(4) 

Locals 

Temp 

Coupling 
i'ona . 


: 

-  Answer  stored  in  fourth  component 

-  Temporary  Real  variable 
: 


SUBROUTINE  HAG(  VeC  ) 
IMPLICIT  NONE 
REAL* 8  Vec(4) 


* - - - - 

REAL* 8  Temp 


Locals 


-  Implementation  - 

Temp=  Vec(l)**2  +  Vec(2)**2  +  Vec(3)**2 
IF  (DABS(Temp) .gt.l.OD-12)  THEN 
Vec(4)=  DSQRT(  Temp  ) 

ELSE 

Vec(4)=  0.0D0 
ENDIF 
RETURN 
END 


* 


SUBROUTINE  NORM 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  Subroutine  calculates  a  unit  vector  given  the  original  vector.  If  a 
zero  vector  is  input,  the  output  is  set  to  zero. 


Algorithm 


Author 


Inputs 

Vec 


Find  the  magnitude  of  the  input  vector  if  not  done 
Check  if  the  magnitude  is  greater  than  zero 

Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  10  Peb  1989 


Vector 


Outputs 

OutVec 

Locals 

Small 

1 


i 

-  Unit  Vector 

t 

-  Tolerance  factor 

-  Index 


Constants  t 

None. 

Coupling  t 

MAG  -  Magnitude  of  a  vector 


SUBROUTINE  NORM(  Vec,  OutVec  ) 
IMPLICIT  NONE 
REAL* 8  Vec(4) ,OutVec(4) 


-  Locals 

REAL* 6  Small 
INTEGER  i 


-  Implementation 

Small  »  O.OOOOOIDO 

CALL  MAG(  Vec  ) 

IF  (  Vec(4).GT. Small  )  THEN 
DO  i*  1,4 

OutVec(l)3  Vec(l)  /  Vec(4) 
END  DO 
EL8E 

DO  1=  1,4 

OutVec(l)3  0.0D0 
END  DO 
ENDIP 
RETURN 
END 


SUBROUTINE  ROT1 


* 


* 

* 


This  Subroutine  performs  a  rotation  about  the  1st  axis. 

Algorithm  i  Store  3rd  component  for  later  use 

Calculate  Sine  and  Cosine  values  to  make  more  efficient 
Plnd  the  new  vector 


Author 


Capt  Dave  Vallado  USAPA/DFAS  719-472-4109  12  Aug  1988 


Inputs 

Vec 

XVal 


i 

-  Input  vector 

-  Angle  of  rotation 


rad 


Outputs  i 

OutVec  -  Vector  result 


Locals 

c 

s 

Temp 

Coupling 

None. 


i 

-  Cosine  of  angle  XVal 

-  Sine  of  angle  XVal 

-  Temporary  RIAL  value 


SUBROUTINE  ROTl{  Vec,  XVal,  OutVec  ) 
IMPLICIT  NONE 

REAL* 8  Vec(4) ,  XVal  ,  OutVec(4) 

-  Locals  — 

REAL* 8  C,S,Temp 

-  Implementation 

Temp=  Vec(3) 
c-  DCoa(  XVal  ) 
s*  DSln(  XVal  ) 

OutVec(3)=  c*Vec(3)  -  s*Vec(2) 
OutVec(2)=  c*Vec(2)  s*Temp 
OutVec (1)*  Vec(l) 

OutVec(4)=  Vec(4) 


RETURN 

END 


SUBROUTINE  ROT2 


This  Subroutine  performs  a  rotation  about  tha  2nd  axis. 

Algorithm  i  Store  3rd  component  for  latar  usa 

Calculate  Slna  and  Coslna  values  to  make  more  efficient 
Find  the  new  vector 


Author 


t  Capt  Dave  Vallado  U8APA/DFA8  719-472-4109  12  Aug  1988 


Inputs 

Vac 

XVal 


-  Input  vector 

-  Angle  of  rotation 


rad 


Outputs 

OutVec 


i 

-  Vector  result 


Locals 

c 

s 

Temp 

Coupling 

None. 


-  Cosine  of  angle  XVal 

-  Sine  of  angle  XVal 

-  Temporary  REAL  value 


SUBROUTINE  R0T2(  Vec,  XVal,  OutVec  ) 
IMPLICIT  NONE 

P.EAL»8  Vec(4) ,  XVal  ,  OutVac(4) 

-  Locals  — 

REAL* 8  C,S,Temp 

-  Implementation 

Tempa  Vec(3) 
c=  DCos(  XVal  ) 
s=  DSln(  xval  ) 

OutVec(3)=  c*Vec(3)  +  a*Vac(l) 
OutVec(l)=  c*Vac(l)  -  s*Tesp 
OutVec(2)=  Vac(2) 

OutVec(4)=  Vac(4) 


RETURN 

END 


SUBROUTINE  ROT 3 


* 

* 


* 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  Subroutine  perform*  a  rotation  about  the  3rd  axi*. 

Algorithm  :  Store  2nd  component  for  later  uae 

Calculate  Sine  and  Coaine  value*  to  make  more  efficient 
Find  the  new  vector 

Author  i  Capt  Dave  Vailado  USATA/DFAS  719-472-4109  12  Aug  1988 


Inputs  < 

Vec  -  Input  vector 

XVal  -  Angle  of  rotation 


rad 


*  Outputs 

*  OutVec 

*  Locals 

*  c 

*  s 

*  Temp 

*  Coupl lng 

*  None . 

* 


: 

-  Vector  reault 

t 

-  Coaine  of  the  angle  XVal 

-  Sine  of  the  angle  XVal 

-  Temporary  UAL  value 

t 


* 


SUBROUTINE  ROT3<  Vec,  XVal,  OutVec  ) 
IMPLICIT  NONE 

REAL*8  Vec(4),  XVal  ,  0utVec(4) 

*  - - — - —  Local*  — 

REAL* 8  C,S,Temp 


-  Implementation 

T*mp=  Vec(2) 
c=  DCo*(  XVal  ) 
s=  DSln(  XVal  ) 

OutVec(2)=  c*Vsc(2)  -  a*Vec(l) 
OutVec(l)*  c*Vec(l)  +  a*T#mp 
OutVec(3)=  Vec(3) 

OutVec(4)=  Vec(4) 

RETURN 

END 


* 


*  D-10  * 


SUBROUT INI  ADD VIC 


This  Subrout ins  adds  two  vectors. 


Algorithm 


Inputs 

Vscl 

Vsc2 


i  Loop  to  find  sach  component 
Find  ths  magnitude  of  ths  vsctor 

>  Capt  Davs  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 


Vector  number  1 
Vector  number  2 


Outputs 

OutVec 


-  Vector  result  of  Vecl  x  Vec2 


Locals 

i 


-  Index 


Coupling 

HAG 


-  Magnitude  of  a  vector 


SUBROUTINE  ADDVSC{  Vecl,Vec2,  OutVec  ) 
IMPLICIT  NONE 

REAL* 8  Vecl(4) ,Vec2(4) ,OutVec(4) 


INTEGER  1 


Locals 


-  Implementation 

DO  1=  1,3 

OutVec(i)=  Vecl(l)  +  Vec2(i ) 
END  DO 

CALL  MAG(  OutVec  ) 

RETURN 

END 


SUBROUT INI  ADD3VBC 


This  Subroutine  adds  three  vectors. 


Algorithm 


Author 

Inputs 

Vecl 

Vec2 

Vec3 


■  Loop  to  find  eaoh  component 
Find  the  magnitude  of  the  vector 

i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  12  Aug  1988 


-  Vector  number  1 

-  Vector  number  2 

-  Vector  number  3 


Outputs 

OutVec 

Locals 

l 

Coupling 

HAG 


Vector  result  of  Vecl  +  Vec2  +  Vec3 


-  Index 


Magnitude  of  a  vector 


SUBROUTINE  ADD3VEC<  Vecl,Vec2,Vec3,  OutVec  ) 
IMPLICIT  NONE 

REAL* 8  Vecl { 4 ) , Vec2 ( 4 ) , Vec3 ( 4 ) ,  OutVec(4) 


INTEGER  i 


Locals 


-  Implementation  - 

DO  t=  1,3 

OutVec ( i )=  Vecl(i)  +  Vec2(l)  +  Vec3(l) 
END  DO 

CALL  HAG{  OutVec  ) 

RETURN 

END 


*  D  11  * 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


SUBROUTINE  LNCOM1 


This  Subroutine  calculate*  the  linear  combination  of  a  vector 
multiplied  by  a  constant. 


Algorithm 


Author 

Inputs 

A 

Vec 


:  Loop  to  find  each  combination 
rind  the  magnitude  of  the  vector 

t  Capt  Dave  Vallado  USATa/DFAS  719-472-4109  21  Aug  1968 


-  constant 

-  Vector 


Outputs 

OutVec 


: 

-  Vector  result  of  A  *  Vec 


Locals 

i 


index 


Coupling 

MAG 


: 

-  Magnitude  of  a  vector 


SUBROUTINE  LNCOMl(  A,Vec,  OutVec  ) 
IMPLICIT  NONE 
REAL* 8  A,Vec(4) ,OutVec(4) 


* 


INTEGER  1 


-  Locals 


-  InplsMntatlon 

DO  1=  1,3 

OutVac(l)*  A*V.c( 1 ) 

ENDDO 

CALL  HAG(  OUtVac  ) 

RETURN 

END 


( 


*  D-12  * 


* 

* 


SUBROUTINE  LNCOM2 


* 


*  Subroutine  calculate*  the  linear  combination  of  two  vectors 

*  multiplied  by  two  constant*. 

* 

*  Algorithm  s  Loop  to  find  each  combination 

*  Find  the  magnitude  of  the  vector 

* 


★ 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


Author 

Inputs 

A1 

A2 

Veol 

Vac2 

Outputs 

OutVec 

Locals 

i 

Coupling 

HAG 


i  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  12  Aug  1988 

i 

-  constant  nuMber  1 

-  constant  number  2 

-  Vector  nuaber  1 

-  Vector  number  2 

> 

-  Vector  result  of  Al*Vecl  +  A2*Vec2 

i 

-  Index 

t 

-  Magnitude  of  a  vector 


* 


SUBROUTINE  LNCOM2(  A1 , A2 , Vecl , Vec2 ,  OutVec  ) 
IMPLICIT  NONE 

REAL* 8  A1 , A 2 , Vecl ( 4 ) , V*c2 ( 4 ) , Ou t Vec ( 4 ) 

-  Locals  - 

INTEGER  1 


-  Implementation  — 

DO  1=  1,3 

OutVec( 1)=  Al*Vecl(l)  +  A2*Veo2(l) 
ENDDO 

CALL  MAG(  OutVec  ) 

RETURN 

END 


»  D-13  * 


SUBROUTINE  LHC OH 3 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  Subroutine  calculate*  the  linear  combination  of  three  vector* 
multiplied  by  three  different  conitant*. 

Algorithm  i  Loop  to  find  each  combination 

Find  the  magnitude  of  the  vector 


Author 


:  Capt  Dave  Vallado  U8AFA/DFA8  719-472-4109  12  Aug  1988 


Inputs 

A1 

A2 

A3 

Vecl 

V*c2 

Vec3 


t 

-  con»tant  number  1 

-  constant  number  2 

-  conitant  number  3 

-  Vector  number  1 

-  Vector  number  2 

-  Vector  number  3 


Outputs 

OutVec 


i 

-  Vector  re*ult  of  Al*Vecl  +  A2*Vec2  +  A3*Vec3 


Locals 

i 


Index 


Coupl lng 
HAG 


: 

-  Magnitude  of  a  vector 


SUBROUTINE  LNCOH3(  Al,A2,A3,Vecl,Vec2,Vec3, OutVec  } 
IMPLICIT  NONE 

REAL* 8  Al,A2,A3,V#Cl(4),V*c2(4),V*c3(4),OutV#C(4) 

-  Locals  - - - 

INTEGER  1 


-  Implementation  - 

DO  1=  1,3 

OutV*c(i)=  Al*Vecl(l)  +  A2*Vec2(i)  +  A3*V*o3(i) 
ENDDO 

CALL  HAG(  OutVec  ) 

RETURN 

END 


* 


*T>14* 


SUBROUTINE  ANGLE 


This  Subroutine  calculates  the  angle  between  two  vectors.  The  output  is 
set  to  999999.1  to  indicate  an  undefined  value.  Be  SURE  to  check  for 
this  at  the  output  phase.  The  tolerance  is  set  for  0.000001,  thus  the 
1.00-12  for  a  squared  test  of  divide  by  aero. 


Algorithm 

Author 

Inputs 

Vecl 

Vec2 


t  Check  the  denominator  for  a  divide  by  sero 
Check  for  exactly  1.0  or  -1.0  to  avoid  ArcCosine  problems 

:  Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  20  Sep  1990 


-  Vector  number  1 
r  Vector  number  2 


Outputs 

Theta 

Locals 

Temp 


Coupling 

DOT 


Angle  between  the  two  vectors 


-  Temporary  REAL  variable 


rad 


Constants  t 

Undefined  -  Undefined  flag  for  a  variable 


-  Dot  Product  of  two  vectors 


SUBROUTINE  ANGLE  (  Vecl,Vec2,  Theta  ) 
IMPLICIT  NONE 

real*8  Vecl(4),Vec2(4), Theta, Temp 


*  - 

1  EXTERNAL  DOT 

REAL* 8  Undefined, Dot 


Locals 


-  Implementation 

Undefined  =  999999. 1D0 


IF  (  Vecl ( 4 ) *Vec2 ( 4 ) .GT . 1 . OD-12  )  THEN 

Temp  =  DOT(Vecl,Vec2)  /  (Vecl(4)*Vec2(4)) 
IF  (  DABS ( Temp ) . g t . 1 . 0D0  )  THEN 
Tamp  =  DSIGN(  l.ODO.Temp  ) 

KNDIP 

Theta  =  DACOS (  Temp  ) 

ELSE 

Theta  =  Undefined 
ENDIP 

RETURN 

END 


*  D-l 5  * 


SUBROUT INK  QUADRATIC 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  subroutine  solves  for  the  two  roots  of  •  quadratic  equation.  There  are 
no  restrictions  on  the  coefficients,  and  Imaginary  results  are  passed 
out  as  separate  values.  The  general  form  Is  y  =  ax2  +  bx  +  c. 


Algorithm  >  Initialise  all  values 
Find  discriminate 

Use  discriminate  value  to  separate  the  root  calculations 
Author  t  Capt  Dave  Vallado  USAFA/DFA8  719-472-4109  10  Jan  1991 


Inputs 

a 

b 

c 


-  Coefficient  of  x  squared  term 

-  Coefficient  of  x  term 

-  Constant 


Outputs 

Rlr 

Rli 

R2r 

R2i 


-  Real  portion  of  Root  1 

-  Imaginary  portion  of  Root  1 

-  Real  portion  of  Root  2 

-  Imaginary  portion  of  Root  2 


Locals 

Discrlm 


i 

-  Discriminate  b2  -  4ac 


Constants  i 

None. 

Coupling  t 

None. 


References 

Escobal 


i 

pg.  433-434 


SUBROUTINE:  Quadratic!  a.b.c,  Rlr, Rli ,R2r,R21  ) 
IMPLICIT  NONE 

REAL* 8  a,b,c,  Rlr,Rll,R2r,R21 
REAL'S  Discrlm 


-  Initialise  - 

Rlr=  0.0D0 
Rll=  0.0D0 
R2r=  O.ODO 
R2i=  O.ODO 

Discrira=  b*b  -  4.0D0*a*c 

-  R#ai  roots  - 

IF  (Discrlm. gt. O.ODO)  THEN 

Rlr=  (  -b  +  DSQRT(Dlscrio)  )  /  (  2.0D0*a  ) 
R2r=  (  -b  -  DSQRT(Discrim)  )  /  (  2.0D0*a  ) 
ELSE 

-  Complex  roots  - 

Rlr=  -b  /  (  2.0D0*a  ) 

R2r=  Rlr 

Rll=  DSQRT( -Discrlm)  /  (  2.0DO*a  ) 

R21=  -DSQRT( -Discrlm)  /  (  2.0D0*a  ) 

END  IF 

RETURN 

END 


*  D  It,  * 


SUBROUTINE  CUBIC 


* 

* 

* 

* 

* 

* 

* 

* 

t 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 


This  subroutine  solves  for  the  three  roots  of  a  cubic  equation.  There  are 
no  restrictions  on  the  coefficients)  and  imaginary  results  are  passed 
out  as  separate  values.  The  general  fora  is  y  *  ax3  +  bx2  +  cx  +  d.  Note 
that  Rli  will  ALWAYS  be  ZERO  since  there  is  ALWAY8  at  least  one  REAL  root. 

Algorithm  t  Initialise  variables 

Find  correct  coeffcients  for  the  fora  of  solution 
IP  Delta  is  positive 

IF  Delta  is  saro 


else 

find  answers  where  Delta  is  negative 

Author  i  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  10  Jan  1991 


Inputs 

a 

b 

c 

d 


-  Coefficient  of  x  cubed  term 

-  Coefficient  of  x  squared  term 

-  Coefficient  of  x  term 

-  Constant 


Outputs 

Rlr 

Rli 

R2r 

R21 

R3r 

R31 


-  Real  portion  of  Root  1 

-  Imaginary  portion  of  Root  1 

-  Real  portion  of  Root  2 

-  Imaginary  portion  of  Root  2 

-  Real  portion  of  Root  3 

-  Imaginary  portion  of  Root  3 


Locals 
Tempi 
Temp2 
Rootl 
Root  2 
Root  3 
P 
0 
R 

Delta 

E0 

Phi 

CosPhi 

SinPhl 

Small 

OneThlrd 


-  Temporary  value 

-  Temporary  value 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  Coefficient  of  x  squared  term  where  x  cubed  term  is  1.0 

-  Coefficient  of  x  term  where  x  cubed  term  is  1.0 

-  Coefficient  of  constant  term  where  x  cubed  term  is  1.0 

-  Discriminator  for  use  with  Cardans  formula 

-  Angle  holder  for  trigonometric  solution 

-  Angle  used  in  trigonometric  solution 

-  Cosine  of  Phi 

-  Sine  of  Phi 

-  Tolerance  factor 

-  1. 0/3.0 


Constants 

Rad 


Radians  per  degree 


Coupling  i 

AT  AN  2  -  Arctangent  including  check  for  180-360  deg 

power  -  Raise  a  number  to  a  power 


References  i 

Escobal  pg.  430-433 


*  D  17  * 


SUBROUTINE  Cubic  {  a,b,c,d,  Rlr,Rll,R2r,R21,R3r,R31  ) 

IMPLICIT  NONE 

REAL* 8  a,b,c,d,  Rlr,Rli,R2r,R2i,R3r,R3i 

*  -  Locals  - 

REAL*8  tempi,  temj>2,  Rootl,  Root2,  Root3,  P,  Q,  R,  Delta, 

&  EO,  CosPbi,  SinPhi,  Phi,  OneThird,  Rad,  Small 

*  -  Initialise  - 

Rad  2  57.29577951308230D0 

OneThird  =  1.0D0/3.0D0 

Small2  0.000001D0 

Rlr  =  0.0D0 

Rli  =  0.0D0 

R2r  2  O.ODO 

R2i  =  O.ODO 

R3r  =  O.ODO 

R3i  =  O.ODO 

Rootl2  O.ODO 

ROOt2=  O.ODO 

Root3=  O.ODO 

*  - Force  coefficients  into  std  fora - 

P=  B/A 
Q=  C/A 
R=  D/A 

a=  OneThird*(  3.0DO*Q  -  P*P  ) 

b=  (l.OD0/27.OD0)*(  2.0D0*P**3  -  9.0D0*P*Q  +  27.0D0*R  ) 

Delta2  (a**3/27.0D0)  +  (b*b/4.QD0) 

*  -  Ui»  Cardans  formula  - 

IF  (Delta. gt. Small)  THEM 

Tempi2  (-b*0.5D0)+D8QRT( Delta) 

Temp2=  (-b*0.5DO)-DBQRT (Delta) 

IF  (DABS(Templ).gt.Saall)  THEN 

Tempi2  D8IGN(l.OD0,Teapl>»(  DSIGN(1.0D0,Templ)*Tenpl  ) 
s  “OneThird 

END  IF 

IF  (DABS(Temp2).gt. Small)  THEN 

Temp2=  DSIGN ( 1 . 0D0 , Teap2 ) * (  DBICN(1.0D0,Temp2)»Temp2  ) 
t  “OneThird 

END  IF 


Rootl2  Tempi  +  Temp2 

Root  2=  -0.5D0*(Tes»pl  +  Teap2) 

Root3=  -0.5D0*(Teapl  +  Terap2) 

R2i  2  -0.5D0»DSQRT(  3.0D0  )* (Tempi  -  Temp2) 

R31  2  -R21 

ELSE 

*  -  Evaluate  aero  point  - 

IF  (DABS(  Delta  ).lt.8mall)  THEN 
IF  (DABS(b).gt. Small)  THEN 

Rootl2  -D8ICN(l.OD0,b)*2.OD0* 

i  (  DSIGN ( 1 . 0D0 , b ) *b/2 . 0D0  )“OneThlrd 

Root 2 2  DSIGN (l.ODO.b)*  (  D8IGN(1.0D0,b)*b/2.0DO  ) 
t  “OneThird 

R00t32  Root 2 


ENDIF 

*  else  let  them  be  O.ODO  since  b  is  O.ODO 

ELSE 

*  -  Use  trigonometric  Identities  - 

EO  2  2.GDO*DSQRT(-a*OnsThlrd) 

CosPhi2  (-b/(2.0D0*DSQRT(-a“3/27.0D0))  ) 
SinPhi2  DSQRT(  1.0D0-CosPhi“2  ) 

Phi  2  DATAN2 (  8inPhl , CosPhi  ) 

Rootl  2  E0*DCo*(  Phl*OneThlrd  ) 

Root 2  2  B0*DCos(  Phi*OnsThlrd  +  120.0D0/Rad  ) 
Root 3  2  E0*DCos(  Phi*OneThird  +  240.0D0/Rad  ) 
END  IF 
ENDIF 

Rlr=  Rootl  -  P*OneThird 
R2r=  Root 2  -  P»OneThird 
R3r2  Root 3  -  P*OneThlrd 
RETURN 
END 


*  D-  18  * 


SUBROUTINE  QUARTIC 


* 

* 

* 

* 

* 

a 

* 

* 

* 

* 

* 

* 

* 

a 

a 

a 

* 

a 

* 

a 

* 

* 

* 

a 

* 

* 

a 

a 

a 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

* 

a 

a 


a 

* 

* 

* 

* 

a 

a 

a 

a 

a 

A 

* 

A 

A 

A 

A 

A 


This  subroutine  solves  for  the  four  roots  of  a  quartic  equation.  There  are 
no  restrictions  on  the  coefficients,  and  imaginary  results  are  passed 
out  as  separate  values.  The  general  form  is  y  -  axi  +  bx3  +  cx2  +  dx  +  e. 


Algorithm  s 

Author  i  Capt  Dave  Vallado  U8AFA/DPAS  719-472-4109  10  Jan  1991 


Inputs 

a 

b 

c 

d 

e 


-  Confident  of  x  fourth  term 

-  Coefficient  of  x  cubed  term 

-  Coefficient  of  x  squared  term 

-  Coefficient  of  x  ter* 

-  Constant 


Outputs 

Rlr 

Rll 

R2r 

R2i 

R3r 

R31 

R4r 

R41 


-  Real  portion  of  Root  1 

-  Imaginary  portion  of  Root  1 

-  Real  portion  of  Root  2 

-  Imaginary  portion  of  Root  2 

-  Real  portion  of  Root  3 

-  Imaginary  portion  of  Root  3 

-  Real  portion  of  Root  4 

-  Imaginary  portion  of  Root  4 


Locals 
Tempi 
Temp2 
Rootl 
Root  2 
Root  3 
s 
h 

hSqr 

hCube 

P 

0 

R 

Delta 

80 

Phi 

CosPhl 

SlnFhi 

Small 

OneThlrd 

RPriroe 

Temp 

Eta 

Beta 


t 

-  Temporary  value 

-  Temporary  value 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  Temporary  value  of  the  root 

-  alternate  variable 

-  Temporary  value 

-  h  squared 

-  h  Cubed 

-  Term  in  auxiliary  equation 

-  Term  in  auxiliary  equation 

-  Term  in  auxiliary  aquation 

-  Discriminator  for  use  with  Cardans  formula 

-  Angle  holder  for  trigonometric  solution 

-  Angle  used  in  trigonometric  solution 

-  Cosine  of  Phi 

-  Sine  of  Phi 

-  Tolerance  factor 

-  1. 0/3.0 

-  Values  of  roots  before  final  work 

-  Temporary  variable  in  finding  MAX  RPrime 

-  Constant  coefficient  in  quadratic  solutions 

-  Constant  coefficient  in  quadratic  solutions 


Constants 

Rad 


i 

-  Radians  per  degree 


Coupling  i 

AT AN 2  -  Arctangent  including  check  for  180-360  deg 

POWER  -  Raise  a  number  to  a  power 


References 

Bscobal 


pg.  430-433 


*  D-19  * 


SUBROUTINE  Quartic(  a,b,C,d,e,  Rlr,Rll,R2r,R21,R3r,R31,R4r,R41  ) 
IMPLICIT  NONE 


REAL* 8  a,b,c,d,e,  Rlr ,R11 ,R2r ,R21 ,R3r ,R3i ,R4r ,R4i 

*  -  Local*  - 

REAL* 8  Tempi,  T#«sp2,  Rootl,  Root2,  Root3,  a,  h,  P,  Q,  R,  Delta, 
£  EO,  OneTblrd,  CoaPhi,  SlnPhi,  Phi,  RPrlroe,  hSqr,  HCube, 

&  Eta,  Beta,  tad,  Small 


»  -  Initialise 

Rad  =  57.295779513O8230D0 

OneThltd  =  1. 0/3,0 

Small*  0.000001D0 

Rlr  =  0.0D0 

Rll  =  0.0D0 

R2r  =  0.0D0 

R21  =  O.ODO 

R3r  =  O.ODO 

R31  =  O.ODO 

R4r  =  O.ODO 

R41  -  O.ODO 

Rootl-  O.ODO 

Root 2=  O.ODO 

Root 3=  O.ODO 


* 


-  Force  coefficient*  Into  atd  form 

b=  B/A 
c=  C/A 
d=  D/A 

*=  E/A 


H  =  -b/4 
HSqr  =  H**2 
HCube  =  H**3 


p*  6.0*HSqr  +  3.0*b*h  *  c 

Q=  4.0*HCube  +  3.0*b*HBqr  +  2.0D0*c*h  +  d 

R=  h* HCube  +  b*HCube  +  c*HSqr  +  d*h  +  * 

a*  (1.0D0/  3.0D0)*{  -P*P-12.0D0*R  ) 

b=  (l.OD0/27.ODO)*{  -2 . 0D0*P*P*P+72 . ODO*P*R-27 . 0D0*Q*O  > 
s*  -(2.0D0/  3.0D0)*P 

Delta=  (a**3/27.0D0)  +  (b»b/4.0D0) 

IF  (DABS(Q).gt. Small)  THEN 

*  -  Uae  Cardan*  formula  - 

IP  (DoLta.gt. Small)  THEN 

Tempi*  <-b*0.5D0)+DSQRT( Delta) 

Temp2=  <-b*0.5D0)-DSQRT(D#lta) 

IF  (DABS{T*apl).gt.8mall)  THEN 

Tempi*  DSIGN(1.0D0, Tempi )*(  DSIGN(1.0D0, Tempi)* 

£  Tempi  )**OneThlro 

END  IF 

IF  (DABS(T*mp2) .gt. Small)  THEN 

Temp 2*  DSIGN(1.0D0,T*mp2)*(  DSIGN(1.0D0,Temp2)» 

£  Tcmp2  )*»OneThlrd 

END  IF 

Rootl*  Tempi  +  T#mp2 

Root 2*  -0.5D0*(Tampl  +  Temp2) 

Root3=  -0.5DQ*(T*mpl  +  Temp2) 

R21  *  -0.5D0*DSQRT(  3.0D0  )*(Templ  -  Temp2) 

R31  *  -R21 

ELSE 

*  -  Evaluate  zero  point  - 

IF  (DABS(  Delta  ). It. Small)  THEN 
IF  (DABS(b).gt. Small)  THEN 

Rootl*  -DSIGN(1.0D0,b)*2.0D0* 

&  (  DBIGN(1.0D0,b)*b/2.0D0  )**OneThlrd 

Root2*  DSIGN(l.ODOib)*  (  DS IGN ( 1 . 0D0 , b ) * b/ 

£  2.OD0  )**OneThlrd 

Root3*  Root2 
END  IF 

*  else  let  them  be  O.ODO  since  b  Is  O.ODO 

ELSE 

*  -  Use  trigonometric  identities  -  - 

EO  =  2,ODO*D8QRT(-a*OneThird) 

Cos Phi*  (-b/(2.OD0*DSQRT(-a**3/27.ODO))  ) 

SlnPhi*  D8QRT(  1.0D0-CosPhi**2  ) 

Phi  *  DAT an 2 (  SlnPhi, CoaPhi  ) 

Rootl  *  80*DCos(  Phl*OneThlrd  ) 

Root 2  =  S0*DCos(  Phi ‘OneThltd  +  120.0D0/Rad  ) 
Root 3  *  S0*DCos(  Phl*OneThlrd  +  240.0D0/Rad  ) 

END  IF 
END  IF 


*  D-20  • 


-  Find  largest  value  of  root  - 

RPrlme=  Rootl+a 

IF  ( (RPrime.lt.Root2+S) .and.(DAB8(R21).lt.O.OOG01DO) )  THEN 
RPrlme*  Root2+s 
ENDIP 

IF  ( (RPrime.lt .Root3+s) .and. (DABS(R31) .lt.O.OOOOlDO) )  THEN 
RPrlrae=  Root3+a 
ENDIP 

-  Evaluate  coefficients  of  two  resulting  Quadratics  - 

IF  (RPrlme.gt. Small)  THIN 

Eta  =  0.5*(  P  +  RPrlme  -  Q/DSQRT(RPrlae)  ) 

Beta-  0. 5* (  P  +  RPrlme  +  Q/D8QRT ( RPr law )  ) 

ELSE 

Sta  =  0.5*P 
Beta=  O.S*P 
ENDIP 

CALL  Quadratic!  1.0D0,  DBQRT(RPrlme) ,Bta, 

6  Rlr,Rll,R2r,R21  ) 

CALL  Quadratlc(  1.0D0,-DSQRT(RPrime) ,Beta, 
t  R3r ,R31 ,R4r ,R41  ) 

ELSE 

-  Case  where  solution  reduces  to  a  quadratic  — - - 

CALL  Quadratic!  1.0,P,R,  Rlr,Rll,R2r,R21  ) 

Rlr=  D9QRT(  Rlr  ) 

Rli=  DSQRT(  Rll  ) 

R2r=  DSQRT (  R2r  ) 

R21-  DSQRT(  R2i  )  ; 

R3r=  -Rlr 
R31=  -Rll 
R4r“  -R2r 
R413  -R21 
ENDIP 

Rlr*  Rlr  +  h 
R2r«  R2r  +  h 
R3r=  R3r  +  h 
R4r=  R4r  +  h 
RETURN 
END 


«  D-21  * 


* 

* 

* 


SUBROUTINE  MAT MULT 


« 

* 

* 

* 

* 

* 

* 

* 

* 


This  Subroutine  multipllea  two  matrlclea  together. 

Algorithm  t  Loop  through  the  Rowe 

Loop  through  the  Cola 
Loop  through  an  Index 

Multiply  and  add  up  each  cell  value 


Author 


l  Capt  Dave  VBllado  U8APA/DPA8  719-472-4109  20  Sep  1990 


Inputa 

Matl 

Mat2 

rl 

cl 

c2 

Maxrl 

Maxr2 

Maxr3 

Maxcl 

I!3xc2 

Maxc3 


-  Matrix  number  1 

-  Matrix  number  2 

-  Actual  number  of  rowa  In  Matl 

-  Actual  number  of  cola  in  Matl 

-  Actual  number  of  cola  In  Nat2 

-  Maximum  number  of  rowa  for  Matl, 

-  Maximum  number  of  rowa  for  Mat2, 

-  Maximum  number  of  rowa  for  Mat3, 

-  Maximum  number  of  cola  for  Matl, 

-  Maximum  number  of  cola  for  Mat2, 

-  Maximum  number  of  cola  for  Mat3, 


the  #  declared 
the  t  declared 
the  f  declared 
the  f  declared 
the  I  declared 
the  t  declared 


In 

stain 

in 

main 

in 

main 

In 

main 

in 

main 

in 

main 

Outputs  : 

Mat3  -  Matrix  reault  of  Matl  *  Mat2 


Locals  « 

row  -  Row  counter  for  Mat3 

col  -  Col  counter  fcr  Mat3 

ktr  -  Additional  counter 

Coupling  i 

None. 


SUBROUTINE  HatMult  (  Matl, Hat2,rl, cl, c2, Maxrl, Haxr2,Maxr3, 
t  MaxCl,MaxC2, MaxCS,  Mat 3  ) 

IMPLICIT  NONE 

INTEGER  rl,  cl,  c2,  Maxrl,  Maxr2,  Maxr3,  Maxcl,  Maxc2,  Maxc3 
REAL* 8  Matl. (Maxrl, MaxCl),  Mat2(Maxr2,MaxC2),  Mat3(Maxr3,MaxC3) 

-  Locale  - 

INTEGER  Row,  Col,  ktr 


-  Implementation  - 

DO  Row  =  1  ,  rl 
DO  Col  =  1  ,  c2 

Hat3(Row,Col)  *  O.ODO 
DO  ktr  3  1  ,  cl 

Mat3(Row,Col)  3  Mat3(Row,Col)  + 

(  Hatl(Row,ktr)  *  Mat2(ktr,Col) 

ENDDO 
ENDDO 
ENDDO 
RETURN 
END 


*  D-22  * 


SURBOUTINE  MATADD 


This  subroutine  adds  two  matricias  together. 

Algorithm  i  loop  through  the  Rows 

loop  through  ths  Cols 
Add  ths  Mtriclss 

Author  »  Capt  Davs  Vallsdo  UBAFA/DFAS  719-472-4109  20  8sp  1990 

Inputs  i 

Hatl  -  Matrix  numbar  1 

Mat2  -  Matrix  numbar  2 

rl  -  Actual  nuaiber  of  rows  In  Matl 

cl  -  Actual  nuatber  of  cols  In  Hatl 

Maxrl  -  Maximum  numbar  of  rows  for  Hatl,  the  #  daclarad  In  main 

Maxr2  -  Maximum  numbar  of  rows  for  Kat2,  tha  I  daclarad  In  main 

Maxr3  -  Maximum  numbar  of  rows  for  Hat3,  tha  t  daclarad  In  main 

Haxcl  -  Maximum  nustbar  of  ools  for  Matl,  tha  #  daclarad  in  main 

Maxc2  -  Maximum  nustbsr  of  cols  for  Hat2,  tha  f  daclarad  In  main 

Maxc3  -  Maximum  numbar  of  cols  for  Mat3,  tha  •  daclarad  in  main 


*  Outputs  I 

*  Hat3  -  Hatrlx  rasult  of  Matl  +  Hat2  of  slsa  rl  x  cl 


*  Locals  i 

*  row  -  Row  countar  for  Mat3 

*  col  -  Col  countar  for  Mat3 

*  Coupling  i 

*  Mono . 

*  References  : 

*  Nona . 


SUBROUTINE  MatAdd  (  Matl ,Mat2 , rl , cl , Maxrl ,Haxr2,Haxr3, 

4  Haxcl ,Haxc2,Kaxc3,  Mat3  ) 

IMPLICIT  NONE 

INTEGER  rl,  cl,  Maxrl,  Haxr2,  Maxr3,  Maxcl,  Maxc2,  Naxc3 
REAL* 8  Hatl (Maxrl, Maxcl),  Hat2(Maxr2,Kaxc2),  Mat3(Maxr3,Maxc3) 

-  Locals  - 

INTEGER  ROW,  Col 

-  Implamantation  - 

DO  Row  *  1  ,  rl 

DO  Col  *  1  ,  cl 

Hat 3 (Row, Col)  *  Hatl(Row,Col)  *  Mat2(Row,Col) 

ENDDO 

ENDDO 


RETURN 

END 


*  D-23  * 


* 

* 


SUBROUTINE  MATTRANS 


*  This  subroutine  finds  the  transpost  of  a  matrix. 

* 

*  Algorithm  :  Loop  through  tha  Rows 

*  Loop  through  tha  Cola 

*  Switch  tha  rowa  tor  coluana 

* 

*  Author  s  Capt  Dava  Vallado  U8AEA/DEA8  719-472-4109  20  8ap  1990 

* 

I 

-  Matrix  numbar  1 

-  Actual  numbar  of  rowa  in  Matl 

-  Actual  numbar  of  cola  in  Matl 

-  Maximum  numbar  of  rowa  for  Matl,  tha  •  daclarad  in  main 

-  Maximum  numbar  of  rowa  for  Mat2,  tha  •  daclarad  lr  main 

-  Maximum  numbar  of  cola  for  Matlr  tha  #  daclarad  ivi  main 

-  Maximum  numbar  of  cola  for  Mat2,  tha  •  daclarad  in  main 

*  Outputs  1 

*  Mat2  -  Matrix  raault  of  tranapoaa  Matl 

* 

*  Locals  i 

*  row  -  Row  countar  for  Mat2 

*  col  -  Col  countar  for  Mat2 

* 

*  Coupl lng  t 

*  Nona. 


*  Inputs 

*  Matl 

*  rl 

»  cl 

*  Maxrl 

*  Maxr2 

*  Maxcl 

*  Maxc2 


SUBROUTINE  MatTrans  (  Matl, rl,cl, Maxrl, Maxr2, Maxcl, Maxc2,  Mat2  ) 
IMPLICIT  NONE 

INTEGER  rl,cl,  Maxrl,  Maxr2,  Maxcl,  Maxc2 
REAL* 8  Matl(Maxrl, Maxcl),  Mat2(Maxr2,Maxc2) 

- - —  Locals  - 

INTEGER  ROW, Col 

- —  Implamantation  - - * — 

DO  Row  =  l,rl 
DO  Col  =  l,cl 

Hjt 2 (Col ,Row)  «  Matl (Row, Col) 

ENDDO 

ENDDO 

RETURN 

END 
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This  subroutine  decomposes  a  matrix  in  to  an  LU  form.  Note  when  used  with 
Matlnverse,  MaxRow  is  set  to  10.  Also,  Scalo  i»  hardwired  to  30. 

Algorithm  i 


Author  i  Maj  Toro  Riggs  USAFA/DPAS  719-472-4109  27  Apr  1989 

Capt  Dave  Vallado  USAFA/DPAS  719-472-4109  20  Sep  1990 

Inputs  s 

Order  -  Order  of  icatrix 

Outputs  i 

L(J  -  LU  decomposition  matrix 

Index  -  Index  vector  for  pivoting 

NaxRow  -  Maximum  number  of  rows  in  the  matricies 

Locals  i 

i  -  Index 

j  -  Index 

k  -  Index 

Imax  -  Pivot  row  pointer 

Scale  -  Scale  factor  vector 

Sum  -  Temporary  Variables 

AMax  -  Temporary  Variables 

Dum  -  Temporary  Variables 

Small  -  Tolerance 

Coupling  i 

None. 

References  i 

Numerical  Recipes  by  Flannery 


* 
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SUBROUTINE  LUDeCoap(  LU, Index, Order .MaxRov  ) 
IMPLICIT  NONE 
INTEGER  MaxRov,  Order 
INTEGER  index (Order) 

REAL* 8  LU(MaxRow,MaxRow) 


INTEGER  1,  j,  k,  isax 

REAL* 8  Sanal Scal«(30) >  Sun,  AMax,  Dun 
* -  lapleaentation 


Snail  =  0.C00001 
IHax  =  0 
DO  I  =  1  ,  Order 
AMax  =  0.0D0 
DO  J  =  1  ,  Order 

IP  (  DAb»(  LU(1, j)  ) .GT.AMax  )  THEM 
AMax  *  DAb*(  LU(if j)  ) 

ENDIP 

ENDDO 

IP  (DABS(AMax).le.Sauill)  THEN 

Wrlte(*,*j  '  Singular  Matrix  ' 

ENDIP 

Scale(i)  =  1.0D0  /  ASiax 
ENDDO 

DO  j  =  1  ,  Order 

DO  i  =  1  ,  j  -  1 
Sun  =  LU ( i i j } 

DO  k  =  1  ,  1  -  1 

Sun  =  Sun  -  LU(i,k)*LU(k,j) 
ENDDO 

LU(i,j)  =  Sun 
ENDDO 

AMax  =  O.ODO 
DO  1  =  j  ,  Order 
Sun  =  LU ( i , j ) 

DO  k  «  1  ,  j  -  1 

Sun  =  Sun  -  LU(i,k)*LU(k,j) 
ENDDO 

LU(l,j)  *  Sun 

Dun  =  Scale ( 1 )*DAbi(Sun) 

IF  (Dun. ga. AMax)  then 
IHax  =  i 
AMax  3  Dun 
ENDIP 

ENDDO 

IF  (j.ne.inax)  than 
DO  k  =  1  ,  Order 

Dun  3  LU(lmax,K) 

LU(lnax,k)  =  LU(j,k  ) 

LU(j,k)  *  Dun 
ENDDO 

Scale(lmax)  *  Scale(j) 

ENDIP 

Index(j)  =  Imax 

IP  (DAba(  LU ( j i j )  ).lt.8nall)  then 
Write(*,*)  '  Matrix  it  Singular  ’ 
ENDIP 

IP  (j.ne. Order)  then 

Dun  *  1.0D0  /  LU ( j , j  ) 

DO  i  3  j  +  l  ,  order 

LU(i,j)  3  Dun»LU(i,j) 

ENDDO 

ENDIP 

ENDDO 

RETURN 

END 
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SURBOUTINE  LUBkSUB 

This  subroutine  finds  the  inverse  of  a  matrix  using  LU  decomposition.  Note, 
when  this  is  used  by  Mailnverse,  MaxRow  is  set  at  10. 

Algorithm  i 


Author  t  Kaj  Too  Riggs  USAFA/DFAS  719-472-4109  28  Apr  1989 

Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  6ep  1990 

Inputs  t 

Order  -  Order  of  matrix 

LU  -  LU  decomposition  matrix 

Index  -  Index  vector  for  pivoting 

HaxRow  -  Maximum  number  of  rows  in  the  matricies 

Outputs  i 

B  -  Solution  Vector 

Locals  > 

1  -  Index 

j  -  Index 

10  -  Pointer  to  non-sero  element 

IPtr  -  Pivot  Row  Pointer 

Sum  -  Temporary  Variables 

Coupling  t 

None. 

References  t 

Numerical  Recipes  by  Flannery 


SUBROUTINE  LUBkSubf  LU, Index, Order, B, MaxRow  ) 
IMPLICIT  NONE 
INTEGER  MaxRow,  Order 
INTEGER  Index(Order) 

REAL* 8  LU(MaxRow, MaxRow), B(MSXROW) 

-  Locals  - 

INTEGER  i,j,iptr,10 
REAL* 8  Sum 

-  implementation  - 

10  =  0 

DO  1  =  1  ,  Order 
IPtr  =  Index(l) 

Sum  =  B(IPtr) 

B(lptr)  *  B(l) 

IF  (IO.ne.0)  THEM 
DO  j  =  10  ,  1  -  1 

Sura  =  Sum  -  LU(l,j)*B(j) 

ENDDO 

ELSE 

IF  (Sum.ne.O.ODO)  THEN 
10  =  I 
END  IF 
END  IF 

B( 1 )=  Sum 
ENDDO 

B(Order)=  B(Order)  /  LU{Order, Order) 

DO  l  =  (Order  -  1),1,  -1 
Sum  =  B ( 1 ) 

DO  j  =  l  +  1  ,  Order 

Sura  *  Sum  -  LU(i,j)*8(j) 

ENDDO 

B(  1  )*  Sum  /  LU ( i ,  1 ) 

ENDDO 

RETURN 

END 
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This  subroutine  finds  the  Inverse  of  •  matrix  using  LU  decomposition.  Note 
the  MAXIMUM  else  matrix  which  may  be  inverted  is  a  10x101! 


Algorithm  t 


Author 


Mai  Tom  Riggs  USAFA/DPAS  719-472-4109  28  Apr  1989 
Capt  Dave  Vallado  U8AFA/DFAS  719-472-4109  22  Mar  1990 


Inputs  i 

A  -  Matrix  to  invert 

Order  -  Order  of  matrix 

MaxRov  -  Maximum  number  of  rows  for  A,  the  #  declared  in  main 


Outputs 

Alnv 


Inverted  matrix 


Locals 

1 

j 

Index 

LU 

B 


-  Index 

-  Index 

-  Index  vector  for  pivoting 

-  LU  decomposition  matrix 

-  Operational  vector  to  form  Matlnv 


Coupling  ! 

LUDecomp  -  rinds  LU  decoepisition  of  a  matrix 
LUBxSub  -  Finds  LU  back  substitute  results  for  system 


References  < 

Numerical  Recipes  by  Flannery 


SUBROUTINE  Matlnverse!  A,Order,MaxRow,  Alnv  ) 
IMPLICIT  NONE 
INTEGER  Order, MaxRov 

real* 8  A(MaxHow,MaxRow),  AInv(MaxRow,MaxRow) 

«  -  Locals  - 

INTEGER  MaxR 
PARAMETER  (MaxR  =  10) 

INTEGER  1, j.Index(MaxR) 

REAL* 8  Lu(MaxR,MaxR) ,B(HaxR) 

*  -  Implementation  - 

DO  1  -  1  ,  Order 
Index! 1)  3  i 
DO  j  =  1  ,  Order 

LU ( i , J )  3  A( i » j ) 

END  DO 
ENDDO 

CALL  LUDecomp!  LU,  Index,  Order,  MaxR  ) 

DO  j  =  1  ,  Order 

DO  l  =  1  ,  Order 
IP  (i.eq.J)  THEN 
B( 1 )  3  1.0D0 
ELSE 

B(i)  =  O.ODO 
END  IF 

ENDDO 

CALL  LUBkSub!  LU,  Index,  Order,  B,  MaxR  ) 

DO  i  =  1  ,  Order 
Alnv(i,j)  =  B( 1 ) 

ENDDO 

ENDDO 

RETURN 

END 
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SUBROUT INI  PRINT HAT 

Thlf  subroutine  prints  a  matrix.  The  user  should  be  aware  of  trying  to  print 
matricies  with  more  than  about  6  columns.  Although  the  code  will  allow  for 
up  to  10  columns  as  written,  the  editing  specification  may  need  to  be 
changed  to  a  smaller  value  than  the  F12.7  to  accomodate  larger  matricies. 
You  do  NOT  have  to  use  all  10  spaces  when  printing  a  matrix. 

Algorithm  <  Write  out  the  title  for  the  matrix 

Loop  through  the  rows  and  print  out  1  row  at  a  time 

Author  t  Capt  Dave  Vallado  USAFA/DFAS  719-472-4109  20  Sep  1990 

Inputs  t 

Matrix  -  Matrix 

Text  -  Text  describing  the  name  of  the  matrix 

row  -  Actual  number  of  rows  in  Matrix 

col  -  Actual  nuiaber  of  cols  in  Matrix 

MaxRow  -  Maximum  number  of  rows  for  Matrix,  the  f  declared  in  main 

MaxCol  -  Maximum  number  of  cols  for  Matrix,  the  •  declared  in  main 

Outputs  i 

None. 

Locals  i 

RowKtr  -  Row  counter  for  Matrix 

ColXtr  -  Col  counter  for  Matrix 

Coupling  i 

None. 


subroutine  PrlntMatrlx(  Matrix, Text, Row, Col, MaxRow, MaxCol  ) 
IMPLICIT  NONE 

INTEGER  MaxRow,  MaxCol,  Row,  Col 
RKAL*8  Hatrlx(MaxRow, MaxCol) 

CHARACTER* 8  Text 

-  Locals  - - 

INTEGER  RowXtr,  ColXtr 

-  Implementation  - 

Wrlte(*,*J  Text 
DO  RowKtr*  1  ,Row 

Wrlte(  *,20  )  (Hat  i' lx  (RowKtr ,  ColXtr )  ,ColKtr»l,Col) 
ENDDO 

FORMAT (  10(F12.7,1X)  ) 

RETURN 

END 
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This  function  calcuates  the  determinant  value  using  L-U  dacompisltion. 
The  formula  must  havt  s  NON-ZERO  numbsr  in  ths  1,1  position.  If  ths 
function  ssnses  a  NON-ZERO  numbsr  in  row  1,  it  sxchangss  rowl  for  a  row 
WITH  a  NON-ZERO  numbsr. 


Algorithm  t 


Author  :  Capt  Davs  Vallado  USAPA/DFA8  719-472-4109  12  Aug  1988 

Inputs  > 

Order  -  Order  of  datarmlnaent  (#  of  rows) 

Matl  -  Matrix  to  find  determinant  of 

HaxRov  -  Maximum  number  of  rows  for  Matrix,  the  I  declared  in  main 


Outputs  i 

Determinant  -  Result 


Locals 

i 


j 


k 

Temp 

D 

Sum 

L 

U 

Small 

Coupling 

None. 


-  Index 

-  Index 

-  Index 


-  Tolerance  for  comparing  to  0.0 


References! 

Marlon  pg.  168-172,  126-127 
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REAL*8  FUNCTION  DETERMINANT (  Order ,Matl,HaxRow  ) 
IMPLICIT  NONE 
INTEGER  Order,  MaxRow 
REAL *8  Matl(  MaxRow, MaxRow  ) 

*  -  Local*  - 

INTEGER  MaxR 
PARAMETER  (MaxR  =  10) 

INTEGER  1, j,k 

REAL* 8  Temp, D, Sum, Small, L(HaxR, MaxR) ,U(MaxR,MaxR) 


*  -  Implementation  - 

'  Small=  O.OOOOOOir.O 
Sum  =  0.0D0 

*  - Switch  a  non  aero  row  to  the  f lr»t  row 


IF  (  DABS (  Matl(l,l)  ).LT. Small)  THEN 
j=  1 

DO  WHILE  (j.LE. Order) 

IF  (  DABS(  Matl( j,l)  ) .GT. Small )  THEN 
DO  k=l, Order 

Temp=  Matl(l,k) 

Matl(l,k)=  Matl( j,k) 
Hatl(j»k)*  Temp 
ENDDO 

j=  Order  +  1 
END  IF 
j=  j+1 
ENDDO 
END  IF 

DO  1=  1, Order 

L(l,l)=  Matl( 1,1) 

ENDDO 

DO  j=  1, Order 

U(l,j>»  Matlfl, j)/L(l,l) 

ENDDO 

DO  j=  2, Order 

DO  1=  j, Order 
Sum=  O.ODO 
DO  k=  l,j-l 

Sum=  Sum+L(l,k)+U(k, j) 

ENDDO 

L(l,j)=  Hatl( 1, j)-  Sum 
ENDDO 

U(j,j)=  1.0 
IF  (j.NE. Order)  THEN 
DO  i=  j+1, Order 
Sum=  O.ODO 
DO  k=  1, j-1 

Sum=  Sum+L( j,k )*U(k, i ) 

ENDDO 

U( j, 1  )=  (Matl( j,i)-3um)/L( j, j) 
ENDDO 
ENDIF 

ENDDO 
D=  1.0D0 
DO  1=  1, Order 
D=  D*L(l,i) 

ENDDO 

Determinant^  D 

RETURN 

END 


+  D-31  • 


APPENDIX  E 


TEST  CASES 


Contents 


-  Misc  Time  Tests  E-l 

-  SITE-TRACK  and  RAZEL  E-2 

-  ELORB  and  RandV  E-4 

-  GIBBS  E-10 

-  HerrGIBBS  E  ll 

-  FindCandS,  NewtonR  E12 

-  KEPLER  E13 

-  GAUSS  E20 

-  PKEPLER  E28 

-  IJKtoLatLon,  Sun,  Moon,SunRiseSet  E-31 

-  RngAz,  Path,  ICBM  E32 

-  Predict  E33 

-  Interplanetary  E36 

-  Rendezvous,  Orbit  Cling  E37 

-  Reentry  E38 

-  Hills  E40 

-  GroundTrack  E42 

-  Cowells  E43 


*’s  indicate  the  answer  is  given  in  the  reference  cited 


MXSC  TIME  Test  Cases 


JUI.IANDAY  and  INVJULIANDAY : 
REF:  Escobal  pg  18-21 


Ephemaris  Values 


— 

GST 

JD 

Year 

Jan 

l,  0  Hr 

Mean 

Calculated 

2451544.5 

2000 

99.9677947 

2451179.5 

1999 

100.2065061 

2450814.4 

1998 

100.4452177 

2450449.5 

1997 

100.6839293 

2450083.5 

1996 

99.9369936 

2449718.5 

1995 

100.1757054 

2449353.5 

1994 

100.4144172 

2448988.5 

1993 

100.6531291 

2448622.5 

1992 

99.9061937 

2448257.5 

1991 

100.1449058 

2447892.5 

1990 

100.3836180 

2447527.5 

1989 

6 

42 

29.7644 

29.3590 

100.62232886 

100.6223302 

2447161.5 

1988 

6 

39 

30.1642 

30.0945 

99.87539345 

99.8753951 

2446796.5 

1987 

6 

40 

27.1354 

27.3855 

100.11410594 

100.1141075 

2446431.5 

1986 

100.3528200 

2446066.5 

1985 

100.5915325 

2445700.5 

1984 

6 

39 

21.7168 

22.7031 

99.84459595 

99.8445978 

2445335.5 

1983 

6 

40 

18.9168 

19.9310 

100.08304553 

100.0833105 

2444970.5 

1982 

100.3220232 

2444605.5 

1981 

100.5607361 

2444239.5 

1980 

6 

39 

14.7690 

15.2510 

99.81354553 

99.8138016 

Da 

ie 

Julian  Date 

Longitude 

GST 

LST 

Day 

Mon 

Yr 

Hr 

Hln 

Sec 

1 

Jan 

1900 

0: 

0: 

0.0000 

2415019.5000000 

-104.883000 

99.1981398 

354.3151398 

*  12 

Oct 

1962 

10:15: 

30.0000 

2437949.9274306 

298.221300 

174.3881886 

112.6091886 

1 

Jan 

1980 

0: 

0: 

0.0000 

2444239.5000000 

-104.883000 

99.8138016 

354.9308016 

*  1 

Jan 

1985 

6:48: 

0.0000 

2446066.7833333 

298.221300 

202.8707893 

141.0920893 

1 

Jan 

1987 

0: 

0: 

0.0000 

2446796.5000000 

-104.883000 

100.1141075 

355.2311075 

31 

Dec 

1987 

0: 

0: 

0.0000 

2447160.5000000 

-104.883000 

98.8897478 

354.0067478 

1 

Jan 

1988 

0: 

0: 

0.0000 

2447161.5000000 

-104.883000 

99.8753951 

354.9923951 

1 

Dec 

1988 

0: 

0: 

0.0000 

2447496.5000000 

0.000000 

70.0672619 

70.0672619 

31 

Dec 

1988 

0: 

0: 

0.0000 

2447526.5000000 

-104.883000 

99.6366828 

354.7536828 

14 

Jul 

1989 

0: 

0: 

0.0000 

2447721.5000000 

0.000000 

291.8379187 

291.8379187 

1 

Aug 

1989 

0: 

0: 

0.0000 

2447739.5000000 

-104.883000 

309.5795713 

204.6965713 

17 

Aug 

1989 

0: 

0: 

0.0000 

2447755.5000000 

-104.883000 

325.3499291 

220.4669291 

17 

Aug 

1989 

14: 

0: 

0.0000 

2447756.0833333 

-104.883000 

175.9249077 

71.0419077 

17 

Aug 

1989 

14:35: 

0.0000 

2447756.1076389 

-104.883000 

184.6988634 

79.8158634 

17 

Aug 

1989 

14 : 3S : 

59.9999 

2447756.1083333 

-104.883000 

184.9495474 

80.0665474 

2 

Oct 

1989 

0: 

0: 

0.0000 

2447801.5000000 

-104.883000 

10.6897079 

265.8067079 

31 

Dec 

1989 

0: 

0: 

0.0000 

2447891.5000000 

0.000000 

99.3979706 

99.3979706 

1 

Jan 

1990 

0: 

0: 

0.0000 

2447892.5000000 

-104.083000 

100.3836160 

355.5006180 

l 

Jan 

1991 

0: 

0; 

0.0000 

2448257.5000000 

-104.883000 

100.1449058 

355.2619058 

1 

Jan 

1992 

0: 

0: 

0.0000 

2448622.5000000 

-104.883000 

99.9061937 

355.0231937 

1 

Jan 

1993 

0: 

0: 

0.0000 

2448988.5000000 

-104.883000 

100.6531291 

355.7701291 

1 

Jan 

1994 

0: 

0: 

0.0000 

2449353.5000000 

-104.883000 

100.4144172 

355.5314172 

1 

Jan 

1995 

0: 

0: 

0.0000 

2449718.5000000 

-104.883000 

100.1757054 

355.2927054 

1 

Jan 

1996 

0: 

0: 

0.0000 

2450083.5000000 

-104.883000 

99.9369936 

355.0539936 

1 

Jan 

1997 

0: 

0: 

0.0000 

2450449.5000000 

-104.883000 

100.6839293 

355.8009293 

1 

Jan 

1998 

0: 

0: 

0.0000 

2450814.5000000 

-104.883000 

100.4452177 

355.5622177 

1 

Jan 

1999 

0: 

0: 

0.0000 

2451179.5000000 

-104.883000 

100.2065061 

355.3235061 

1 

Jan 

2000 

0: 

0: 

0.0000 

2451544.5000000 

-104.883000 

99.9677947 

355.0847947 

2 

jan 

2000 

0: 

0: 

0.0000 

2451545. 5000000 

-104.883000 

100.9534420 

356.0704420 

2 

oct 

2000 

0: 

0: 

0.0000 

2451819.5000000 

-104.883000 

11.0208203 

266.1378203 

*  Es 

■oba  1 

pg. 

18, 

21 

and  22 

E- 1 


SITE-TRACK  and  RAZBL  Test  Cases 


NOTICE  the  same  data  set  is  used  for  both  SITE-TRACK  tests  and  the  RAZEL 
test  cases.  RAZEL  is  simply  the  inverse  process  of  finding  the  range, 
azimuth,  elevation,  and  rate  terms  from  the  vectors. 

*1.  BMW  Appendix  D.1,1 

Given: 

39.0070  deg  Latitude 
-104.8830  deg  Longitude 
7180.0000  ft  Altitude 
317.0200  Universal  Time 

2  Day 

Sep  Month 

1970  Year 

Find:  i  j  k  magnitude 

RS  =  0.2045751  -0.7510033  0.6262484  0.9990216  DU 

VS  =  0.0441842  0.0120359  0.0000000  0.0457942  DU/TU 

R  =  0.2790794  -0.7751794  0.6374576  1.0417008  DU 

V  =  0.2634728  -0.1492353  0.0519525  0.3072265  DU/TU 

2.  BMW  Appendix  D.1,2 

37.8000  deg  Latitude 
-175.9000  deg  Longitude 

0.0000  ft  Altitude 
1905.1500  Universal  Time 

8  Day 

Oct  Month 

1970  Year 

RS  =  -0.4806057  0.6284402  0.6095710  0.9987471 

VS  =  -0.0369734  -0.0282758  0.0000000  0.0465462 

R  =  -0.4691328  0.6521522  0.6485385  1.0324680 

V  =  0.0186569  -0.3501725  -0.5839385  0.6811410 

3.  BMW  Appendix  D.l,3 

29.8000  deg  Latitude  1510.00000  km 

-78.5000  deg  Longitude  180.00000  deg 

15.0000  ft  Altitude  45.00000  deg 

2210.5750  Universal  Time  4.50000  km/s 

27  Day  0.50000  deg/s 

Dec  Month  0.53000  deg/s 

1970  Year 

RS  =  0.8558456  -0.1476259  0.4940560  0.9991779 

VS  =  0.0086854  0.0503525  0.0000000  0.0510961 

R  s  1.0809849  -0.1864604  0.4319837  1.1789426 

V  =  0.8084630  -1.2700249  1.5558259  2.1649873 

«*  Tests  combination  of  azimuth  and  elevation  since  Az=180  and  El  =  45  ** 

**  is  the  same  as  Az=0  and  El  =  135  ** 

4.  eMW  Appendix  D.1,4 

0.0000  deg  Latitude 
80.0401  deg  Longitude 
0.0000  ft  Altitude 
0.0000  Universal  Time 

1  Day 

Jan  Month 

1970  Year 

RS  =  -0.9999889  -0.0047078  0.0000000  1.0000000 

VS  =  0.0002770  -0.0588329  0.0000000  0.0588336 

R  =  -1.9999822  -0.0094157  0.0000000  2.0000044 

V  =  0.0062952  -1.3371525  -0.7040786  1.5112058 

**  Tests  condition  where  satellite  is  directly  overhead  with  small  Del  ** 
Tolerance  check  case  for  RAZEL 


6378.16500  km  Range 

120.00000  deg  Azimuth 

90.00000  deg  Elevation 

0.00000  km/s  Range  rate 

0.00000  deg/s  Azimuth  rate 
-0.10000  deg/s  Elevation  rate 


Range 
Azimuth 
Elevation 
Range  rate 
Azimuth  rate 
Elevation  rate 


300.00000  km  Range 

315.00000  deg  Azimuth 

45.00000  deg  Elevation 

-5.00000  km/s  Range  rate 

-0.20000  deg/s  Azimuth  rate 
-0.30000  deg/s  Elevation  rate 


504.68000  km  Range 

105.60000  deg  Azimuth 

30.70000  deg  Elevation 

2.08000  km/s  Range  rate 

0.05000  deg/s  Azimuth  rate 
0.07000  dag/s  Elevation  rate 


E-2 


SITE-TRACK  and  RAZEL  Test  Cases  (  Continued  ) 


5. 


BMW  Appendix  D 

.1:5 

Given: 

45.7000  deg 

Latitude 

897.50000 

km 

Range 

72.9000  deg 

Longitude 

201.VQ000 

deg 

Azimuth 

3610.0000  ft 

Altitude 

76.70000 

deg 

Elevation 

1024.3000 

Universal  Time 

-0.57000 

km/s 

Range  rate 

15 

Day 

-0.75000 

deg/s 

Azimuth  rate 

Nov 

Month 

0.48000 

deg/s 

Elevation  rate 

1970 

Tear 

Find:  l  j  k  ■ 

RS  =  0.1588097  -0.6814766  0.7122471 

VS  =  0.0400937  0.0093433  0.0000000 


magnitude 
0.9984622  DU 
0.0411680  DU/TU 


R 

V 


0.1737448  -0.7983034  0.7892482 

0.5975069  0.5823526  0.6294953 


1.1359526  DU 
1.0451858  DU/TU 


*6.  USAFA  Astro  451  Problem  «  2 


Given: 


77.0000  deg 

Latitude 

35533.92100  km 

Range 

-68.0000  deg 

Longitude 

169.85700  deg 

Azimuth 

0.0000  ft 

Altitude 

61.88300  deg 

Elevation 

1801.0000 

Universal  Time 

-0.23720  km/s 

Range  rate 

1 

Day 

-0.00355  d*g/a 

Azimuth  rate 

Feb 

Month 

0.00433  deg/s 

Elevation  rate 

1979 

year 

Find:  i 

j 

k 

magnitude 

RS 

=  0.2021307 

-0.1003493 

0.9709376 

0.9968182 

VS 

=  0.0059049 

0.0118921 

0.0000000 

0.0132769 

R 

=  3.6534009 

-1.2975403 

5.1773391 

6.4680590 

V 

=  -0.1535650 

0.4116385 

0.20*8733 

0.4847696 

*7.  USAFA  Astro  321  Problem  I  1 
Given: 


77.7000  deg 

Latitude 

3409.25300  km 

Range 

-66.5000  deg 

Longitude 

37.66050  deg 

Azimuth 

164.0000  ft 

Altitude 

31.10590  deg 

Elevation 

308.0000 

Universal  Time 

-1.18340  ka/s 

Range  rate 

10 

Day 

-0.12671  deg/s 

Azimuth  rate 

Jan 

Month 

0.02544  deg/s 

Elevation  rate 

I9«t> 

Year 

Find:  i 

j 

k 

magnitude 

RS  ;  0.0000091 

0.2135659 

0.9736285 

0.9968084 

VS  -  0.0125648 

0.0004712 

0.0000000 

0.0125737 

R  -  o. 2824806 

■  0. 0709120 

1.3206178 

1.3523517 

V  -  0.7770328 

-0.3392076 

0.1526145 

0.8621931 

■LORI  and  RANDV  Tast  Cases 


Notice  this  data  set  may  be  used  for  both  ELORB  and  RANDV  tests. 


*1.  USAFA  Astro  320  Handout  Problem  #1.1 


R 

V 


i 

1.1372844 

0.6510489 


j  k 

-1.0534274  -0.8550194  1.7703625  DU 

0.4521008  0.0381088  0.7935440  DU/TU 


p 

= 

1.9199998 

a 

= 

1.9999997 

e 

= 

0.1999999 

i 

= 

29.9999997 

Omega 

= 

29.9999963 

Argp 

- 

219.9999795 

Nuo 

= 

65.0000223 

H 

= 

45.5811951 

U 

- 

Undefined 

L 

= 

Undefined 

Cappl 

= 

Undefined 

****  Test  of  Elliptical  Inclined  Orbit 


*2.  USAFA  Astro  320  Handout  Problem  #1.2 


R  ®  1.0561942  -0.8950922  -0.0823703  1.3869106 

V  *  -0.5981066  -0.6293575  0.1468194  0.8805557 


P 

= 

1.4849799 

a 

= 

1.4999797 

0 

= 

0.1000000 

1 

r 

170.0000001 

Omega 

= 

299.9999875 

Argp 

E 

25.0000239 

Nuo 

2 

314.9999636 

H 

* 

322.6859034 

U 

3 

Undefined 

L 

3 

Undefined 

Cappi 

3 

Undefined 

**“  Test  of  Elliptical  Inclined  Orbit 

*3.  USAFA  Astro  320  Handout  Problem  #1.3 


R  =  -0.4222777  1.0078857  0.7041832  1.3000100 

V  =  -0.5002738  -0.5415267  0.47r  788  0.8770547 


P 

= 

1.3000101 

a 

s 

1.3000101 

e 

= 

0.0000001 

i 

53.0000018 

Omega 

80.0000026 

Argp 

= 

Undefined 

NUO 

S 

Undefined 

H 

= 

44.9999979 

U 

3 

44.9999979 

L 

3 

Undefined 

Cappl 

= 

Undefined 

****  Test  of  Circular  Inclined  Orbit 


>4.  USAFA  Astro  320  Handout  Problem  #1.4 


R  =  -0.7309361  -0.6794646  -0.8331183  1.3000099 

V  =  -0.6724131  0.0341802  0.5620652  0.8770547 


P 

2 

1.3000100 

a 

= 

1.3000100 

e 

= 

0.0000001 

i 

= 

115.0002009 

Omega 

= 

200.0000000 

Argp 

a 

Undefined 

Nuo 

= 

Undefined 

H 

315.0000000 

U 

z 

315.0000000 

L 

= 

Undefined 

Cappi 

- 

Undefined 

Test  of  Circular  Inclined  Orbit 


E-  4 


ELORB  and  RANDV  Test  Cases 


*5.  USAFA  Astro  320  Handout  Problem  #1.5 


R 

V 


-3 . 5651640 
0.3143612 


-3.5651640 

-0.2555279 


0.0000000 

0.0000000 


5.0419033 

0.4051141 


P 

a 

e 

i 

Omega 

Argp 

Nuo 

H 


4.1280004 

4.3000002 

0.1999999 

0.0000000 

Undefined 

Undefined 

204.9999984 

216.1768671 


u  =  Undefined 
L  =  Undefined 
Cappi  =  20.0000016 


*6 . 


*►**  Test  of  Elliptical  Equatorial  Orbit 

USAFA  Astro  320  Handout  Problem  #1.6 


***•» 


K  = 

4.4279958 

0.3873994  -0.0000000 

4.4449100 

V  = 

0.0842152 

-0.4585911  0.0000000 

0.4662596 

P 

s 

4.2570599 

a 

= 

4.3000605 

e 

2 

0.1000000 

l 

5 

180.0000000 

Omega 

= 

Undefined 

Argp 

= 

Undefined 

Nuo 

= 

115.0000235 

M 

= 

104.2906454 

U 

Undefined 

L 

= 

Undefined 

Cappi 

= 

239.9999770 

>*«• 

Test  of  Elliptical  Equatorial  Orbit 

**** 

USAFA 

Astro  320  Handout  Problem  #1.7 

R  = 

0.9720220 

2.0845079  0.0000000 

2.3000000 

V  = 

-0.5976017 

0.2786662  0.0000000 

0.(593805 

P 

5 

2.3000002 

a 

S 

2.3000002 

e 

= 

0.0000001 

1 

= 

0.0000000 

Omega 

Undefined 

Argp 

= 

Undefined 

Nuo 

- 

Undefined 

M 

~ 

64.9999999 

U 

3 

Undefined 

L 

3 

64.9999999 

Cappi 

= 

Undefined 

k  *  *  * 

Tost  of  Circular  Equatorial  Orbit 

USAFA 

Astro  320  Handout  Problem  #1.8 

R  = 

-0.2004582 

2.2912478  -0.0000000 

2.3000000 

V  = 

0.6568713 

0.0574688  -0.0000000 

0.6593804 

P 

s 

2.2999998 

a 

= 

2.2999998 

e 

0.0000001 

i 

= 

180.0000000 

Omega 

= 

Undefined 

Argp 

= 

Undefined 

Nuo 

= 

Undefined 

H 

* 

265.0000002 

U 

- 

Undefined 

L 

= 

265.0000002 

Cappi 

= 

Undefined 

t  *  *  * 

Test  of  Circular  Equatorial  Orbit 

ttt* 

e-s 


ELORB  and  RANDV  Test  Cases 


*9.  USAFA  Astro  320  Handout  Problem  11.9 


R  = 
V  = 


0.5916109 

1.1486347 


-1.28893S9 

-0.0908249 


-0.3738343 

-0.1942733 


p 

= 

2.2000003 

a 

= 

Infinity 

e 

= 

1.0000002 

1 

= 

15.0000008 

Omega 

3 

35.0000066 

Argp 

= 

199.9999965 

Duo 

s 

59.9999980 

M 

s 

323.8301540 

U 

s 

Undefined 

L 

2 

Undefined 

Cappi 

= 

Undefined 

****  Test  of  Parabolic  Inclined  Orbit 

>10.  USAFA  Astro  320  Handout  Problem  81.10 


R  =  -1.0343646 
V  =  0.1322278 


-0.4814891 

0.7785322 


0.1735524 

1.0532856 


P 

= 

2.2000002 

a 

3 

Infinity 

e 

= 

1.0000001 

i 

= 

120.0000012 

Omega 

2 

210.0000011 

Argp 

= 

34.9999971 

Nuo 

s 

335.0000053 

M 

= 

313.2492351 

U 

: 

Undefined 

L 

= 

Undefined 

Cappi 

8 

Undefined 

****  Test  of  Parabolic  Inclined  Orbit 

*11.  USAFA  Astro  320  Handout  Problem  #1.11 


R  = 
V  = 


0.9163903 

0.1712704 


G. 7005747 
1.1036199 


-1.3909623 

-0.3810377 


P 

= 

2.4150303 

a 

5 

-3.5000428 

e 

s 

1.3000001 

l 

3 

55.0000008 

Omega 

= 

94.9999992 

Argp 

2 

215.0000065 

Nuo 

3 

74.9999925 

M 

= 

12.1085408 

U 

s 

Undefined 

L 

= 

Undefined 

Cappi 

= 

Undefined 

****  Test  of  Hyperbolic  Inclined  Orbit 

*12.  USAFA  Astro  320  Handout  Problem  #1.12 


R  =  12.3160223 
V  =  -0.5902725 


-7.0604653 

0.2165037 


-3.7883759 

0.1628339 


P 

= 

2.4151907 

a 

= 

-3.5002757 

e 

= 

1.3000001 

i 

3 

165.0000006 

Omega 

s 

235.0000236 

Argp 

3 

35.0000182 

Nuo 

= 

230.0000046 

M 

= 

170.1406418 

U 

5 

Undefined 

L 

3 

Undefined 

Cappi 

= 

Undefined 

Test  ot  Hyperbolic  Inclined  Orbit 


E-t> 


1.4666667 

1.1677485 


**** 


1.1540634 

1.3164373 


**•* 


1.8070286 

1.1800424 


**•* 


14.6930721 

0.6494693 


*  *  ft  * 


**** 


ELORB  and  RANDV  Test  Casts 


*1.  USAFA  Astro  320  Handout  Problem  #1.1  Final 


*3. 


R  = 

-0.4395790 

-0.8344110  -0.4611020 

1.0498031 

V  = 

0.8660850 

-0.36S6480  -0.1816190 

0.9756180 

P 

1.0489991 

a 

= 

1.0490002 

e 

= 

0.0009997 

1 

= 

28.5000027 

Omega 

S 

357.9999498 

Argp 

= 

26.9945554 

Nuo 

= 

220.0054910 

H 

s 

220.0791812 

U 

= 

Undefined 

L 

= 

Undefined 

Cappi 

s 

Undefined 

**** 

Example  of 

!  a  shuttle  orbit 

**** 

USAFA 

Astro  320  Handout  Problam  #1.2  Final 

R  = 

0.7764100 

0.5236950  0.5407000 

1.0813998 

V  = 

-0.3986130 

-0.2688680  0.8327940 

0.9616279 

P 

1.0814006 

a 

= 

1.0814006 

e 

= 

0.0000008 

i 

= 

90.0000093 

Omega 

= 

33.9999974 

Argp 

a 

Undefined 

Nuo 

a 

Undefined 

H 

= 

30.0000075 

U 

z 

30.0000075 

L 

= 

Undefined 

Cappi 

= 

Undefined 

**** 

Example  Polar  orbit,  surveillance 

**•* 

USAFA 

Astro  320  Handout  Problam  #1,3  rtnal 

R  = 

-3.9752320 

-1.0966930  0.6458080 

4.1739996 

V  = 

-0.0050220 

-0.2347100  -0.4294930 

0.4894673 

P 

Z 

4.1739975 

a 

- 

4.1739975 

0 

= 

0.0000009 

1 

= 

62.9999994 

Omega 

= 

20.0000073 

Argp 

= 

Undefined 

Nuo 

= 

Undefined 

H 

= 

170.0000023 

U 

z 

170.0000023 

L 

= 

Undefined 

Cappi 

= 

Undefined 

**** 

Sample  of 

a  GPS  orbit 

USAFA 

Astro  320  Handout  Problem  #1,4  Final 

R  * 

56.2767910 

46.0649980  -31.1585420 

80.3005354 

V  = 

-0.3494800 

0.2659280  0.1972370 

0.4814108 

P 

Z 

4.8275047 

a 

= 

-4.8344217 

e 

= 

1.4137076 

1 

= 

146.5000870 

Omega 

= 

279.9998432 

Argp 

= 

86.9995231 

Nuo 

= 

228.3303462 

H 

= 

101.5948009 

U 

Z 

Undefined 

L 

= 

Undefined 

Cappi 

- 

Undefined 

*  *  *  * 

Sample  Comet  orbit 

*»** 

E  7 


KL0R8  and  RANDV  Tact  Casaa 


*5.  USAFA  Astro  320  Handout  Problesi  #1.5  Final 


0.08S88S0 

-0.5553150 


0.0601370 

-0.3888360 


1.1983940 

0.1058350 


1.2029717 

0.6861263 


P 

a  = 

e  = 

i  = 

Omtga  - 


0.6781607 

0.8390608 

0.4379285 

90.0000140 

35.0000152 


Argp  =  269.9999740 
Nuo  =  175.0000189 
H  =  168.5231854 


U  =  Undefined 
L  =  Undefined 
Cappl  =  U.  *  *lned 


****  Simple  ICBM  trajectory 

USAFA  Astro  320  Handout  Problem  #1.6  Final 


4.6744710 

0.2750180 


-4.6744710 

0.2750180 


0.0000000 

0.0000000 


6.6107003 

0.3889342 


P 

a  = 
e  = 
i  = 
Omega  = 
Argp  = 
Nuo  = 
M  = 


6.6106958 

6.6106958 

0.0000007 

0.0000000 

Undefined 

Undaflnad 

Undaflnad 

315.0000000 


-  Undaflnad 
L  a  315.0000000 
Cappi  =  Undaflnad 


Sample  Communication  or  Early  Warning  Satellite  **** 


*1.  USAFA  Astro  320  Handout  Problem  <1.6  variation 


R  =  -2.5494956 
V  =  0.3550439 


3.6410571 

0.3022281 


-0.0000000 

-0.0000000 


4.4449100 

0.4662596 


4.2570597 

4.3000604 

0.1000001 

180.0000000 

Undefined 

Undefined 

115.0000153 

104.2906221 

Undaflnad 

Undefined 

119.9999850 


2.  BHW  orbit  #1  pg.  65 

R  -  1.0606602  1.0606602 

V  =  0.4618802  -0.6928203 


-0.0000000 

0.0000000 


1.5000000 

0.8326664 


1.5000000 
1.5625000 
0.2000000 
18C. 0000000 
Undefined 
Undefined 
269.9999886 
292.7645813 

Undefined 

Undefined 

45.0000114 


Note  that  1  In  BHW  la  redundant  for  this  case 


Hlsc  elorb  and  RANDV  Tait  Caits 


3.  BMW  orbit  #2  pg.  66 


R  = 
V  = 


0.0000000 
0. 0000000 


-1.2353675 

0.5773503 


1.2353675 

0.4140510 


1.7470735 

0.7104728 


p 

= 

1.5000002 

£ 

= 

1.5625001 

e 

= 

0.1999999 

i 

= 

90.0000000 

Omega 

= 

270.0000000 

Argp 

= 

179.9999769 

Nuo 

= 

22S. 0000231 

M 

= 

243.0447589 

U 

Undefined 

L 

= 

Undefined 

Cappi 

= 

Undefined 

»*  Note  that  u  and  1  In  BMW  are  redundant  for  this  cat*  ** 


4.  BMW  orbit  #3  pg.  67 


R 

V 


0.3750000 

-0.7071068 


0.6495191 

0.4082483 


-1.2990381 

-0.0000000 


1.5000000 

0.8164966 


p  =  1.5000001 
a  =  1.5000001 
e  =  0.0000001 
i  =  59.9999985 
Omega  =  150.0000001 
Argp  =  Undefined 
Nuo  =  Undefined 
M  =  270.0000009 

U  -  270.0000009 
L  =  Undefined 
Cappi  -  Undefined 

*•  Note  that  1  is  redundant  for  thia  case  *• 


5.  USAFA  Astro  320  Handout  Problem  91.1  Kxtra 


R  -  -1.1000000  0.0000000  0.0000000  1.1000000 

V  -  -0.0045379  0.010000C  0.0000001  0.0109815 


P 

= 

0.0001210 

a 

= 

0.5500365 

e 

0.9998900 

i 

= 

180.0000000 

Omega 

= 

Undefined 

Argp 

Undefined 

Nuo 

179.9971397 

M 

= 

179.2286881 

U 

- 

Undefined 

L 

= 

Undefined 

cappi 

= 

0.0028603 

****  Teat  the  accuracy  of  tolerances  in  program  **** 

6.  USaFA  Astro  320  Handout  Problem  #1.2  Extra 


R  =  0.0228098  -0.1302512  0.9943682  1.0031220 

V  =  -0.0110796  0.0678955  -0.4985516  0.5032755 


P 

0.0000068 

a 

= 

0.5745511 

e 

S 

0.9999941 

l 

= 

87.6756823 

Omega 

= 

262.1614208 

Argp 

= 

262.713S085 

NUO 

= 

180.0750475 

H 

= 

259.9215100 

U 

s 

Undefined 

l 

= 

Undefined 

Cappi 

= 

Undefined 

**  ** 


Test  of  Rectilinear  Ellipse  Orbit 


***• 


E-9 


GIBBS  Test  Cases 

*1.  BHW  example  pg.  115 


Given: 

i 

3 

k 

Find: 

R1  = 

0.000000 

0.000000 

1.000000 

DU 

R2  = 

0.000000 

-0.700000 

-0.800000 

DU  V2  = 

R3  = 

0.000000 

0.900000 

0.500000 

DU 

*2 .  BHW  pg.  146  problem  2.13s 


R1 

=  1.414225 

0.000000 

1.414202 

R2 

*  1.810657 

1.060669  ' 

0.310651 

V2  = 

R3 

=  1.353540 

1.414225  -0.646450 

BMW 

pg.  147  problem  2.13b 

R1 

a  0.707113  0.000000  0.707101 

R2 

=  -0.894979  0.565681  -0.949642 

V2  = 

R3 

=  -0.094979  -0.565681  -0.894977 

***  Vectors  are  not  coplanar  *** 


4. 

BHW 

pg.  147  problem  2.13c 

R1 

=  1.000000 

0.000000 

0.000000 

R2 

=  -0.800000 

0.600000 

0.000000 

V2 

R3 

a  0.800000 

-0.600000 

0.000000 

5. 

BMW 

pg.  147  problem  2.13d 

R1 

a  0.207096 

3.S35528 

1.207125 

R2 

=  0.914201 

4.949742 

1.942347 

V2 

R3 

=  1.621305 

6.363955 

2.621344 

6 . 

BMW 

pg.  147  problem  2.13e 

R1 

a  1.000000 

0.000000 

0.000000 

R2 

a  0.000000 

1.000000 

0.000000 

V2 

R3 

a  -1.000000 

0.000000 

0.000000 

7. 

BHW 

pg.  147  problem  2.13f 

R1 

=  7.000000 

2.000000 

0.000000  DU 

R2 

a  1.000000 

1.000000 

0.000000  DU 

V2 

R3 

=  2.000000 

7.000000 

0.000000  DU 

to* 

Orbit  is  not  possible 

*** 

8. 

BMW 

pg.  147  problem  2.13g 

R1 

=  0.000000 

2.700000 

0.000000 

R2 

=  2.970000 

0.000000 

0.000000 

V2 

R3 

a  -2.970000 

0.000000 

0.000000 

9. 

USAFA  Astro  451 

Problem  |3 

R1 

a  0.000000 

1.100000 

0.000000 

R2 

a  -1.212992 

-2.057288 

1.212992 

V2 

R3 

a  0.000000 

-3.300000 

0.000000 

10. 

USAFA  Astro  321 

Problem  82 

R1 

a  0.000000 

1.200000 

0.000000 

R2 

=  -1.212992 

-2.157288 

1.212992 

V2 

R3 

a  0.000000 

-3.400000 

0.000000 

11. 

K1 

=  1.200000 

0.000000 

0.000000 

R2 

a  -0.800000 

0.000000 

0.900122 

V2 

R3 

a  0.000000 

0.900000 

0.000000 

*00 

Vectors  are 

not  coplanar  *** 

i  j  k  magnitude 

0.0000000  0.69S6701  -0.6567445  0.9596101  DU\TU 

160.2405290 


-0.0912544  0.3128428  -0.5336687  0.6253001 

45.0000138 


0.0000000  0.0000000  0.0000000  0.0000000 


-0.6000000  -0.8000000  0.0000000  1.0000000 
180.0000000 


0.2509219  0.5018595  0.2475890  0.6132932 
7.0617969 


-1.0000000  0.0000000  0.0000000  1.0000000 

90.0000000 


0.0000000  0.0000000  0.0000000  0.0000000 


0.0580259  -0.5802589  0.0000000  0.5831529 

180.0000000 


0.1475475  -0.4985584  -0.1475475  0.5404637 
140.1776177 


0.1752110  -0.4974362  -0.1607665  0.5513507 

142.6525475 


0.0000000  0.0000000  0.0000000  0.0000000 
0.0000000 
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HERRICK -GIBBS  Test  Caitl 


»1.  USAFA  Astro  451  Problem  #3 

Given:  i  j  k  Unlv  Time  Find:  1  j  k  magnltu 

R1  =  0.000000  1.100000  0.000000  DU  1201.00000 

R2  =  -1.212992  -2.057288  1.212992  DU  1309.55480  V2  =  -0.0000000  -0.8214425  0.0000000  0.82144 

R3  =  0.000000  -3.300000  0.000000  DU  1418.50960  140.1776177 

**  Angles  are  too  far  apart  ** 


*2.  USAFA  Astro  321  Problem  #2 

R1  =  0.000000  1.200000  0.000000  1133.00000 

R2  =  -1.212992  -2.157288  1.112992  1241.55450  V2  *  0.0038602  -0.7776137  -0.0035420  0.77763 

R3  =  0.000000  -3.400000  0.000000  1349.50900  142.6525475 

**  Angles  are  too  far  apart  ** 


*3.  USAFA  Astro  321  Problem  »1  Fall  88 

R1  =  0.53618414  0.94382196  0.43658524  0.000000 

R2  =  0.51957094  0.95496111  0.43247339  0.169917  V2  *  -0.7922407  0.5226298  -0.1980809  0.96954 

R3  =  0.50281293  0.96583641  0.42824155  0.339865  1.0000002 


*4.  USAFA  Astro  321  Problem  12  Fall  88 


R1 

=  0.53618414 

0.94382196 

0.43658524 

0.000000 

R2 

-  0.46030868 

0.99185440 

0.41714307 

1.164760  V2 

“  -0.8148447  0.4778570  -0.2176481  0.96937 

R3 

=  0.38176536 

1.03437523 

0.39533848 

2.330378 

4.5000004 

*5.  USAFA  Astro  321  Problem  «3  Fall  88 

R1  =  0.53618414  0.94382196  0.43658524  0.000000 

R2  =  -1.04241241  0.71031097  -0.25535014  27.197046  V2  *  -0.5086478  -0.5539836  -0.3345728  0.82314 

R3  =  -0.65533617  -1.15356018  -0.53360418  62.369619  90.0000004 


R1 

3 

0.207096 

3.535528 

1.207125 

3.7417 

R2 

3 

0.914201 

4.949742 

1.942347 

5.3952 

V2 

•  6.5998156 

13.1992165 

6.6074758 

16.16856 

R3 

S 

1.621305 

6.363955 

2.621344 

7.0711 

7.0617969 

R1 

- 

1.200000 

0.000000 

0.000000 

0.0000 

R2 

3 

-0.800000 

0.000000 

0.800122 

1000.0000 

V2 

*  0.0000000 

0.0000000 

0.0000000 

0.00000 

R3 

s 

0.000000 

0.900000 

0.000000 

2000.0000 

0.0000000 

***  vectors  are  not  coplanar  *** 
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FindCandSs 

REF:  BMW  chart  on  pg.  209 


Z 

-39.47842 

0.00000 

0.57483 

39.47842 

50.00000 


C 

5.83559577 

0.50000000 

0.47650300 

0.00000000 

0.00589304 


S 

0.97444596 

0.16666667 

0.16194146 

0.02533029 

0.01799504 


NevtonRi 

REF i  BMW  chart  on  pg.  221 


Eccentricity 

Haan  Anomaly  dag 

Eccentric  Anomaly  dag 

True  Anomaly  di 

0.04844 

151.7425 

153.002000 

154.236000 

0.00000 

90.0000 

90.000000 

90.000000 

0.49900 

90.0000 

115.751233 

140.098510 

0.50000 

90.0000 

115.793623 

140.177613 

0.51110 

90.0000 

116.261345 

141.049998 

0.99900 

90.0000 

132.321144 

178.867518 

1.00000 

90.0000 

132.346459 

180.000000 

0.00000 

270.0000 

270.000000 

270.000000 

0.49900 

270.0000 

244.248767 

219.901490 

0.50000 

270.0000 

244.206377 

219.822387 

0.51110 

270.0000 

243.738655 

218.950002 

0.99900 

270.0000 

227.678856 

181.132482 

1.00000 

270.0000 

227.653541 

180.000000 

*  (Roy  pg  85) 
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KEPLER  Test  Cases 


*1.  BMW  example  problem  pg.  210 


Ro  = 

1.0000000 

0.0000000 

0.0000000 

1.0000000 

Vo  = 

Dt  = 

0.0000000 
2.00000  TU 

0.0000000 

1.1000000 

1.1000000 

R  = 

-0.3206670 

0.0000000 

1.2364349 

1.2773404 

V  = 

-0.8799766 

-0.0000000 

-0.0373113 

0.8807672 

R  = 

-0.3187509 

-0.0000000 

1.2367231 

1.2771398 

V  =  -0.8801728 

Iterations) 

0.0000000 

-0.0359836 

0.8809082 

» 

X 

tn 

dt 

xn  c 

s 

1 

1.58000 

1.70506 

1.22178 

1.82140  0.15098 

0.42304 

2 

1.82140 

2.00684 

1.27860 

1.81605  0.14614 

0.39990 

3 

1.81605 

2.00000 

1.27734 

1.81605  0.14625 

0.40044 

Two-Body 

Two-Body  New 

Perturbed  New 

p 

= 

1.210000 

1.2099960 

1.2100000 

a 

S 

1.266000 

1.2658188 

1.2658228 

e 

= 

0.210000 

0.2100003 

0.2100000 

i 

S 

90.000000 

90.0000000 

90.0000000 

Omega 

= 

0.000000 

0.0000000 

0.0000000 

Argp 

B 

0.000000 

359.9990766 

359.9554007 

Nu 

B 

0.000000 

104.5401464 

104.4973687 

M 

= 

0.000000 

80.4633328 

80.4188239 

U 

& 

Undefined 

Undefined 

Undefined 

L 

= 

Undefined 

Undefined 

Undefined 

cappl 

= 

Undefined 

Undefined 

Undefined 

2.  BMW  Appendix  D.3,1 


Ro  = 

0.0000000 

1.0000000  0.0000000  1.0000000 

Vo  = 

DC  = 

0.0000000 
3.14159  TU 

0.0000000  1.0000000  1.0000000 

R  » 

0.0000000 

-1.0000000  0.0000000  1.0000000 

V  = 

-0.0000000 

-0.0000000  -1.0000000  1.0000000 

3.04734 

3.04734 

1.00000  3.14159  0.10436  0.21489 

3.14159 

3.14159 

1.00000  3.14159  0.10132  0.20264 

P  “ 

1.0000000 

1.0000000 

a  = 

1.0000000 

1.0000000 

o  * 

0.0000000 

0.0000000 

i  = 

90.0000000 

90.0000000 

Omega  - 

90.0000000 

90.0000000 

Argp  = 

Undefined 

Undefined 

Nu  * 

Undefined 

Undefined 

M  = 

0.0000000 

179.9999998 

u 

0.0000000 

179.9999998 

L  =■ 

Undefined 

Undefined 

Cappl  = 

Undefined 

Undefined 

**  Tests  first  guess  being  too  close  ** 


1.97216 

2.62093 

2.6054S 


9.28631 

9.86960 
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KEPLER 

Test  Cases 

(  Continued  ) 

*3.  BMW 

Appendix  D.3/2 

Ro  = 

0.0000000 

0.0000000 

-0.5000000 

0.5000000 

VO  = 

0.0000000 

2.0000000 

0.0000000 

2.0000000 

Dt  = 

1000000.00000  TU 

R  s  0.0000000  181.7065561  16508. 1362596  16509.1362596 

V  =  0.0000000  0.0000606  0.0110064  0.0110066 


1  181.60401  998308.06507  16490.50885  181.70661 

2  181.70661  1000000.95604  16509.14678  181.70656 

3  181.70656  1000000.00000  16509.13626  181.70656 


0.16667 

0.16667 

0.16667 


0.50000 

0.50000 

0.50000 


0.00000 

0.00000 

0.00000 


P 

= 

1.0000000 

a 

= 

Infinity 

e 

= 

1.0000000 

i 

3 

90.0000000 

Omega 

- 

90.0000000 

Argp 

= 

270.0000000 

Hu 

3 

0.0000000 

M 

3 

0.0000000 

U 

5 

Undefined 

L 

= 

Undefined 

Cappi 

= 

Undefined 

Tests  first 


1.0000000 

Infinity 

1.0000000 

90.0000000 

90.0000000 

270.0000000 

179.3693656 

0.0000000 

Undef lned 
Undefined 
Undefined 

luesa  for  a  parabolic  case  " 


i.  BMW  Appendix  D.3,3 


Ro  = 

0.3000000 

1.0000000 

0.0000000  1.0440307 

Vo  = 

3.0000000 

0.0000000 

0.0000000  3.0000000 

Dt  = 

5.00000  TU 

R  = 

13.9623306 

-0.1172043 

0.0000000  13.9628225 

V  = 

2.6781140 

-0.2375952 

0.0000000  2.6886328 

l 

1.07476 

4.70954 

13.17760 

1.09680 

0.24966  0.94757 

-8.18323 

2 

1.09680 

5.00844 

13.97719 

1.09620 

0.25380  0.97132 

-8.52232 

3 

1.09620 

5.00002 

13.95466 

1.09620 

0.25369  0.97066 

-8.51295 

4 

1.09620 

5.00000 

13.95462 

1.09620 

0.25369  0.97066 

-8.51293 

P 

3 

9.0000000 

9.0209898 

a 

3 

-0.1411563 

-0.1411331 

e 

= 

8.0473056 

8.0571195 

i 

s 

180.0000000 

180.0000000 

Omega 

= 

Undefined 

Undefined 

Argp 

= 

Undefined 

Undefined 

Nu 

3 

18.7455592 

92.5176401 

M 

= 

120.4376913 

123.2503893 

U 

Undefined 

Undefined 

L 

= 

Undefined 

Undefined 

Cappi 

= 

267.95368SO 

267.9633079 
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KEPLER  Test  Case*  (  Continued  ) 


5.  BMW  Appendix  D.3,4 

Ro  =  0.5000000  0.7000000  0.8000000  1.1747340 

Vo  =  0.0000000  0.1000000  0.9000000  0.9055385 

Dt  =  -20.00000  TU 

R  =  0.0401556  0.2664818  1.9566242  1.9750958 

V  =  -0.2291452  -0.2755040  0.0410620  0.3606883 

R  =  -0.0345322  0.1776451  1.9665741  1.9748833 

V  =  -0.2269849  -0.2802384  0.0122192  0.3608393 


» 

1 

2 

3 

4 


Two-Body 

Two-Body  New 

Perturbed  Rev 

p 

S 

0.507500 

0.5075000 

0.5075000 

a 

= 

1.133000 

1.1331277 

1.1331277 

e 

= 

0.743051 

0.7430509 

0.7430509 

i 

s 

85.975300 

85.9753157 

85.9753157 

Omega 

= 

50.710600 

50.7105931 

51.1301413 

Argp 

r 

263.200600 

263.2005657 

266.1157703 

!lu 

= 

139.853500 

180.0632823 

180.4983038 

M 

= 

0.000000 

180.2872918 

182.2620600 

U 

Undefined 

Undefined 

Undefined 

L 

s 

Undefined 

Undefined 

Undefined 

Cappi 

= 

Undefined 

Undefined 

Undefined 

**  Tests  elliptical  orbit  with  multi-revs,  and  backward*  propogation  ** 


Iterations! 

x  tn  dt  xn  c  *  * 

-4.27355  -3.33825  1.75082  -5.13271  0.07389  0.10191  16.11755 

-5.13271  -4.97455  1.97359  -5.06579  0.05188  0.03832  23.24957 

-5.06579  -4.84241  1.97510  -5.06583  0.05342  0.04210  22.64727 

-5.06583  -4.84248  1.97510  -5.06583  0.05342  0.04210  22.64758 


6.  BMW  Appendix  D.3,5 


Ro  * 

0.0259170 

-0.1506890  1.1388780  1.1490962 

Vo  * 

0.0003610 

0.0019740  0.0021770  0.0029608 

Dt  * 

) 

.50000  TU 

R  = 

0.0085365 

-0.0529898  0.3863987  0.3901086 

V  = 

0.0412043 

-0.2434089  1.8235400  1.8401749 

R  = 

0.1795636 

0.3559402  1.0177988  1.0930923 

V  = 

-0.0502841 

-0.0990878  -0.2771914  0.2986335 

2.61073 

1.37264 

0.02563  3.10763 

0.09159  0.16476 

11.86306 

3.10763 

1.43116 

0.24285  3.39110 

0.07137  0.09370 

16.80859 

3.39110 

1.52675 

0.43715  3.32990 

0.06081  0.06177 

20.01489 

3.32990 

1.50137 

0.39261  3.32642 

0.06301  0.06808 

19.29898 

3.32642 

1.50000 

0.39010  3.32641 

0.06314  0.06845 

19.25860 

Two-Body 

Two-Body  New 

Perturbed  Hew 

P 

s 

0.000010 

0.0000068 

0.0000068 

a 

= 

0.575000 

0.5745364 

0.5745510 

e 

= 

0.999994 

0.9999941 

0.9999941 

l 

= 

87.675500 

87.6755397 

87.6755397 

Omega 

s 

262.160300 

262.1602976 

57.2818408 

Argp 

= 

262.713600 

262.7135482 

248.6861358 

Nu 

s 

179.999700 

179.7256034 

180.0445312 

M 

3 

179.668730 

17.0114300 

49.8512900 

u 

- 

Undefined 

Undefined 

Undefined 

L 

= 

Undefined 

Undefined 

Undefined 

Cappi 

= 

Undefined 

Undefined 

Undefined 

«*  Tests  rectilinear  ellipse  and  x  larger  than  TwoPi  square  root  of  a  ** 
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BMW 

kepler  Test  Cases 

Appendix  D.3,6 

(  Continued 

) 

Ro  = 

-0.5000000 

0.0000000 

0.0000000 

0.5000000 

Vo  = 
Dt  = 

0.0000000 
1000.00000  TU 

1.9990000 

0.0000000 

1.9990000 

R  = 

152.6766761 

14.5709289 

0.0000000 

153.3703993 

V  = 

0.0950524 

0.0025250 

0.0000000 

0.0950859 

1 

3.99900 

12.60289 

8.43757 

15.70138 

0.16613 

0.49734 

0.06395 

2 

15.70138 

620.70914 

113.73956 

19.03611 

0.15864 

0.46025 

0.98589 

3 

19.03611 

1076.59133 

160.51588 

18.55895 

0.15500 

0.44246 

1.44913 

4 

18.55895 

1001.67034 

153.52879 

18.54807 

0.15556 

0.44518 

1.37739 

5 

18.54307 

1000.00086 

153.37048 

18.54807 

0.15557 

0.44524 

1.37578 

6 

18.54807 

1000.00000 

153.37040 

18.54807 

0.15557 

0.44524 

1.37578 

P 

= 

0.9990003 

0.9990002 

a 

- 

250.0625156 

250.0625156 

e 

S 

0.9980005 

0.9980005 

i 

3 

180.0000000 

180.0000000 

Omega 

= 

Undefined 

Undefined 

Argp 

s 

Undefined 

Undefined 

Nu 

= 

0.0000000 

174.5484021 

H 

= 

0.0000000 

14.4893779 

U 

= 

Undefined 

Undefined 

L 

Undefined 

Undefined 

Cappi 

= 

180.0000000 

180.0000000 

**  Tests  x  larger  than  TwoPl  square  root  of  a  ** 


*8.  Kaplan  example  problem  pg.  307 


Ro  = 

1.5679000 

0.0000000 

0.0000000 

Vo  = 

0.0000000 

1.1638000 

0.0000000 

Dt  = 

13.38600  TU 

1.5679000 

1.163B000 


R 

V 


-4.8259941 

-0.4571857 


7.3013686 

0.3135849 


0.0000000 

0.0000000 


8.7521542 

0.5543953 


Iterations: 


» 

X 

tn 

dt  xn 

c 

s 

3 

1 

-2.27833 

-5.83264 

4.58493  1.91337 

0.17011 

0.51729 

-0.40924 

2 

1.91337 

4.33083 

3.67462  4.37762 

0.16909 

0.51214 

-0.28863 

3 

4.37762 

23.80414 

13.75970  3.62047 

0.17972 

0.56621 

-1.51083 

4 

3.62047 

15.03431 

9.58837  3.44857 

0.17549 

0.54457 

-1.03341 

5 

3.44857 

13.45554 

8.78785  3.44065 

0.17466 

0.54031 

-0.93760 

6 

3.44065 

13.38614 

8.75223  3.44064 

0.17462 

0.54012 

-0.93330 

7 

3.44064 

13.38600 

8.75215  3.44064 

0.17462 

0.54012 

-0.93329 

P  s 

3.3296105 

3.3296116 

a  =  - 

■12.6840963 

-12.6840731 

e  = 

1.1236115 

1.1236117 

i  = 

0.0000000 

0.0000000 

Omega  = 

Undefined 

Undefined 

Argp  = 

Undefined 

Undefined 

Nu  = 

0.0000000 

123.4635459 

H  - 

0.0000000 

16.9779486 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  = 

0.0000000 

0.0000076 

Tests  Hyperbolic  first  guess 

**** 
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KEPLER  Test  Cases  (  Continued  ) 
*9.  BMW  problem  pg.  224  #4.9 


RO  = 

0.0000000 

1.1000000 

0.0000000 

1.1000000 

Vo  = 

1.4142140 

0.0000000 

0.0000000 

1.4142140 

Dt  = 

2.22000  TU 

R  = 


2.4048811 


0.0125729 


0.0000000 


2.4049140 


V  = 

0.7747505 

-0.6428154  -0.0000000  1 

.0067025 

1 

-2.92864 

-8.65183 

6.95066  -1.36450 

0.18016 

0.56815 

-1.55945 

2 

-1.36450 

-2.01771 

2.24898  0.51978 

0.16951 

0.51427 

-0.33852 

3 

0.51978 

0.59992 

1.26277  1.80274 

0.16708 

0.50205 

-0.04912 

4 

1.80274 

3.18987 

3.14786  1.494(4 

0.17166 

0.52511 

-0.59089 

5 

1.49464 

2.32559 

2.48(36  1.45217 

0.17008 

0.51715 

-0.40617 

6 

1.45217 

2.22171 

2.40623  1.45146 

0.16989 

0.51618 

-0.38342 

7 

1.45146 

2.22000 

2.40491  1.45146 

0.16989 

0.51617 

-0.38305 

p  = 

2.4200015 

2.4200016 

a  - 

-5.4999626 

-5.4999621 

e  = 

1.2000014 

1.2000014 

1  = 

180.0000000 

180.0000000 

Omega  = 

Undefined 

Undefined 

Argp  = 

Undefined 

Undefined 

Nu  * 

0.0000000 

89.7004544 

M  = 

0.0000000 

9.8613428 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  a  : 

270.0000000 

270.0000017 

•10.  BMW  problem  pg.  225  14.18 


RO  =  0.2000000 
Vo  *  3.1622770 
Dt  =  219.60000  TU 


0.0000000  0.0000000  0.2000000 

0.0000000  0.0000000  3.1(22770 


R  •  60.1009021  0.0000000  0.0000000  60.1009021 


V  = 

0.1824184 

0.0000000 

0.0000000  0. 

1824184 

1 

10.94471 

258.57402 

67.01540 

10.36314 

0.1(667 

0.50000 

0.00000 

2 

10.36314 

221.52504 

60.45160 

10.33130 

0.16667 

0.50000 

0.00000 

3 

10.33130 

219.60557 

60.10196 

10.33121 

0.1(667 

0.50000 

0.00000 

4 

10.33121 

219.60000 

60.10095 

10.33121 

0.16667 

0.50000 

0.00000 

2.42000 

2.42000 


-5.500 

-5.500 


1.200001 

1.200001 


180.0000 

180.0000 


0.0000 

0.0000 


0.0000 

0.0000 


0.0000  0.0000 

0.0000  0.0000 


0.0000 

0.0000 


0.0000 

0.0000 
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KEPLER  Test  Casts  (  Continued  ) 


A423 

Skills  Test  #1 

RO  = 

1.6118775 

2.2769723  -1.2822678 

3.0703359 

Vo  = 

-0.4250056 

0.2604223  0.0542680 

0.5013926 

Dt  = 

214.17654  TU 

R  = 

1.8809513 

-1.6342999  -0.0981493 

2.4937015 

V  = 

0.4770905 

0.3231269  -0.2645644 

0.6340510 

p 

=  2.3437501 

2.3437501 

a 

=  2.5000000 

2.5000000 

c 

=  0.2500000 

0.2500000 

i 

=  24.9999999 

24.9999999 

Omega 

=  135.0000010 

134.1680458 

Argp 

=  79.9999986 

81.4260368 

Nu 

=  198.8108615 

103.9177230 

H 

=  209.9999997 

75.0993655 

U 

=  Undefined 

Undefined 

L 

=  Undefined 

Undefined 

Cappl 

=  Undefined 

Undefined 

A423 

Skills  Test  12 

Ro  = 

2.755141S 

-1.3550490  0.0000000 

3.0703359 

Vo  = 

0.1728093 

0.4706713  0.0000000 

0.5013926 

Dt  = 

214.17654  TU 

R  = 

-1.2456159 

-2.1633243  0.0000000 

2.4963035 

V  = 

0.4524628 

-0.4432404  0.0000000 

0.6333914 

p 

=  2.3437501 

2.3437501 

a 

=  2.5000000 

2.5000000 

e 

=  0.2500000 

0.2500000 

1 

=  0.0000000 

0.0000000 

Omega 

a  Undefined 

Undefined 

Argp 

=  Undefined 

Undefined 

Nu 

3  198.8108623 

104.1491546 

H 

3  210.0000011 

75.3374320 

U 

*  Undefined 

Undefined 

L 

3  Undefined 

Undefined 

Cappi 

3  134.3999987 

135.9180301 

A423 

Skills  Test  83 

RO  = 

-2.3828847 

0.1171153  0.7470906 

2.5000000 

Vo  = 

0.0296281 

-0.6028275  0.1890006 

0.6324555 

Dt  = 

214.17654  TU 

R  = 

1.S826718 

1.6215515  -1.0562767 

2.5000000 

V  = 

-0.4506182 

0.4437419  0.0060304 

0.6324555 

p 

3  2.5000000 

2.5000000 

a 

=  2.5000000 

2.5000000 

e 

3  0.0000000 

0.0000000 

l 

=  25.0000000 

25.0000000 

Omega 

=  134.9999996 

134.2688031 

Argp 

=  Undefined 

Undefined 

Nu 

=  Undefined 

Undefined 

M 

3  45.0000003 

271.2927914 

U 

=  45.0000003 

271.2927914 

L 

3  Undefined 

Undefined 

Cappi 

3  Undefined 

Undefined 
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KEPLER  Test  Casas  (  Continued  ) 
14.  A423  Skills  Test  #4 


Ro  = 

-1.7677670 

1.7677670  0.0000000 

2.5000000 

Vo  = 
Dt  = 

-0.4472136 
214.17654  TU 

-0.4472136  0.0000000 

0.6324555 

R  = 

2.4995703 

0.0463477  0.0000000 

2.5000000 

V  = 

-0.0117251 

0.6323468  0.0000000 

0.6324555 

p 

- 

2.5000000 

2.5000000 

a 

= 

2.5000000 

2.5000000 

e 

= 

0.0000000 

0.0000000 

i 

S 

0.0000000 

0.0000000 

Omega 

= 

Undefined 

Undefined 

Argp 

= 

Undefined 

Undefined 

NU 

S 

Undefined 

Undefined 

M 

= 

135 .0000000 

1.0622709 

U 

— 

Undefined 

Undefined 

L 

s 

135.0000000 

1.0622709 

Cappi 

= 

Undefined 

Undefined 
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GAUSS  Taft  Caiex 


*1.  BMW  Appendix  D.4/1  and  pg.27S  5.11a 


R1  =  0.5000000 

R2  =  0.0000000 

Delta  time  = 


0.6000000  0.7000000 
-1.0000000  0.0000000 
20.0000000  TU  Dong  Way 


1.0488088 

1.0000000 


V12  =  -0.1229814 
V22  =  0.6698699 


1.1921622  -0.1721740  1.2107927 

0.4804848  0.9378179  1.2486368 


Iterations: 


* 

Z 

y 

X 

0 

0.00000 

2.99624 

2.44795 

1 

19.73921 

1.47495 

4.79505 

2 

29.60881 

1.18407 

10.24734 

3 

24.67401 

1.29916 

6.54703 

4 

27.14141 

1.23460 

8.00517 

5 

25.90771 

1.26506 

7.20509 

20 

26.85471 

1.24136 

7.80435 

21 

26.85473 

1.24136 

7.80436 

22 

26.85472 

1.24136 

7.80436 

tn  vara  upper  lower 
1.28525  -0.670  39.47842  0.00000 

5.98349  -0.670  39.47842  19.73921 
40.59459  -0.670  29.60881  19.73921 
12.82559  -0.670  29.60881  24.67401 
21.34479  -0.670  27.14141  24.67401 
16.32057  -0.670  27.14141  25.90771 

19.99996  -0.670  26.85475  26.85471 
20.00005  -0.670  26.85473  26.85471 
20.00001  -0.670  26.85472  26.85471 


P 

= 

1.3282282 

1.3282282 

a 

= 

2.2680559 

2.2680559 

e 

= 

0.6437204 

0.6437204 

i 

= 

54.4623222 

54.4623222 

Omega 

= 

270.0000000 

270.0000000 

Argp 

= 

59.3433343 

59. 3433343 

Nu 

- 

65.5518930 

300.6566657 

M 

s 

13.0845681 

348.5688217 

U 

s 

Undef inod 

Undefined 

L 

= 

Undefined 

Undefined 

Cappi 

= 

Undefined 

Undefined 

2.  BMW  Appendix  D.4,2 


.  = 

0.3000000 

0.7000000 

0.4000000 

0.8602325 

!  - 

0.6000000 

-1.4000000 

0.8000000 

1.7204651 

Delta 

time  » 

5.0000000  TU 

Short  Way 

;  s 

0.7326124 

-0.1048188 

0.9768165 

1.2255115 

!  = 

-0.3438450 

-0.1048188 

-0.4584600 

0.5825822 

0 

0.00000 

1.16648 

1.52741 

1.67394 

1.000 

39.47842 

0.00000 

1 

19.73921 

3.43729 

7.32002 

26.03536 

1.000 

19.73921 

0.00000 

2 

9.86960 

2.58070 

3.56865 

6.21125 

1.000 

9.86960 

0.00000 

3 

4.93480 

1.95276 

2.(4978 

3.30956 

1.000 

9.16960 

4.93480 

4 

7.40220 

2.28527 

2.97388 

4.53124 

J.000 

9.86960 

7.40220 

5 

8.63590 

2.43747 

3.26097 

5.30134 

1.000 

8.63590 

7.40220 

17 

8.17658 

2.38187 

3.15185 

4.99985 

1.000 

8.17688 

8.17658 

18 

8.17673 

2.38189 

3.15188 

4.99994 

1.000 

8.17688 

8.17673 

19 

8.17681 

2.38190 

3.15190 

4.99999 

1.000 

8.17688 

8.17681 

P 

0.8228737 

0, 

.8228737 

a  = 

1.2149570 

1, 

.2149570 

e  = 

0.5680790 

0, 

,5680790 

1  =  ] 

L26. 8698976 

126, 

.8698976 

Omega  = 

90.0000000 

90 . 

.0000000 

Argp  *  301.1532226 

301, 

.1532226 

NU  = 

94.3844552 

203, 

,3090996 

H  = 

31.1518847 

245, 

.0714534 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  s 

Undefined 

Undefined 
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GAUSS  Test  Casas 


(  Continued  ) 


3. 


BMW  Appendix  D.4,3 


R1 

R2 


0.5000000 

0.0000000 


Delta  time  = 


0.6000000 
1.0000000 
1.2000000  TU 


0.7000000 
0.0000000 
Bong  Way 


1.0488088 

1.0000000 


V12  =  -0.4053006  -0.9427690  -0.5674209 
V22  =  0.2282041  1.1462875  0.3194858 


1.1726246 

1.2116614 


0 

0.00000 

3.86474 

2.78020  1.05725  -1.284 

39.47842 

0.00000 

1 

19.73921 

0.94890 

3.84604  2.25659  -1.284 

19.73921 

0.00000 

2 

9.86960 

2.04881 

3.17970  1.41934  -1.284 

9.86960 

0.00000 

3 

4.93480 

2.85511 

2.96220  1.21082  -1.284 

4.93480 

0.00000 

4 

2.46740 

3.33287 

2.86767  1.12883  -1.284 

4.93480 

2.46740 

5 

3.70110 

3.08744 

2.91396  1.16836  -1.284 

4.93480 

3.70110 

12 

4.63602 

2.91020 

2.95033  1.20024  -1.284 

4.63602 

4.62638 

13 

4.63120 

2.91109 

2.95014  1.20Q08  -1.284 

4.63120 

4.62638 

14 

4.62879 

2.91154 

2.95004  1.19999  -1.284 

4.63120 

4.62879 

p  = 

0.1541483 

0.1541483 

a  = 

1.8801350 

1.8801350 

e  - 

0.9581295 

0.9581295 

1 

125.5376778 

125.5376778 

Omega  = 

90.0000000 

90.0000000 

Argp  = 

208.0160964 

208.0160964 

Nu  = 

207.0886763 

151.9839036 

M  = 

346.1845632 

12.8542076 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  = 

Undefined 

Undefined 

4.  BMW  Appendix  D.4,4 


R1  =  -0.2000000 
R2  =  0. 4C0000Q 


Delta  time  = 


0.6000000  0.3000000 

1.2000000  0.6000000 

50.0000000  tu  Short  Way 


0.7000000 

1.4000000 


V12  =  -0.1616701  1.4377416 

V22  =  -0.1616701  -0.9613760 


0.7188708 

-0.4806880 


1.6155536 

1.0869415 


Iterations: 


* 

Z 

y 

x  tn 

vara 

upper 

lower 

0 

0.00000 

0.20263 

0.63661  0.64694 

1.342 

39.47842 

0.00000 

1 

19.73921 

3.24923 

7.11696  24.64273 

1.342 

39.47842 

19.73921 

2 

29.60881 

3.83177 

18.43411  243.19086 

1.342 

29.60881 

19.73921 

3 

24.67401 

3.60129 

10.90041  65.26346 

1.342 

24.67401 

19.73921 

4 

22.20661 

3.44164 

8.74226  38.96151 

1.342 

24.67401 

22.20661 

5 

23.44031 

3.52541 

9.73914  50.C0039 

1.342 

23.44031 

22.20661 

18 

23.44016 

3.52540 

9.73901  49.99882 

1.342 

23.44031 

23.44016 

19 

23.44024 

3.52540 

9.73907  49.99960 

1.342 

23.44031 

23.44024 

20 

23.44027 

3.52541 

9.73910  50.00000 

1.342 

23.44031 

23.44027 

p 

0.0453848 

0.0453848 

a  = 

4.0464609 

4.0464609 

e  = 

0.9943762 

0.9943762 

i  = 

153.4349488 

153.4349488 

Omega  = 

180.0000000 

180.0000000 

Argp  : 

273.2706090 

273.2706090 

Hu  = 

160.1278414 

193.3309406 

M  = 

2.0933119 

354.0421994 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  = 

Undefined 

Undefined 
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GAUSS  Test  Cases  (  Continued  ) 


5.  BMW  Appendix  D.4,5  and  pg.  275  5.11c 


R1  = 

1.0000000 

0.0000000  0.0000000  1.0000000 

R2  = 

0.0000000 

1.0000000  0.0000000  1.0000000 

Delta  time  = 

0.0001000  TU  Short  Way 

V12  = 

0.0000000 

0.0000000  0.0000000  0.0000000 

V22  = 

0.0000000 

0.0000000  0.0000000  0.0000000 

0 

0.00000 

0.58579 

1.08239  0.97672  1.000  0.00000-12.56637 

1 

-2.86239 

0.04886 

0.27820  0.22517  1.000  -2.86239  -2.86239 

2 

-2.86239 

0. 04886 

0.27820  0.22517  1.000  -2.86239  -2.36239 

3 

-2.86239 

0.04886 

0.27820  0.22517  1.000  -2.86239  -2.86239 

20  ' 

-2.86239 

0.04886 

0.27820  0.22517  1.000  -2.86239  -2.86239 

29 

-2.86239 

0.04886 

0.27820  0.22517  1.000  -2.86239  -2.86239 

30 

-2.86239 

0.04886 

0.27820  0.22517  1.000  -2.86239  -2.86239 

P 

Undefined 

Undefined 

a  - 

Undefined 

Undefined 

e  = 

Undefined 

Undefined 

1  = 

Undefined 

Undefined 

Omega  = 

Undefined 

Undefined 

Argp  = 

Undefined 

Undefined 

Nu  = 

Undefined 

Undefined 

M  = 

Undefined 

Undefined 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  = 

Undefined 

Undefined 

** 

1  Tests  point  whore  t 

la  very  close  to  0.  NOT  possible  to  converge 

6. 

BMW  Appendix  D.4,6 

R1  = 

-0.4000000 

0.6000000  -1. 

,2010000 

1  1.4008572 

R2  = 

0.2000000 

-0.3000000  0. 

,6000000 

>  0.7000000 

Delta 

time  = 

5.0000000  TU  Short  Way 

V12  = 

0.2551050 

-0.3826576  -0. 

,5738817 

0.7354220 

V22  = 

-0.7292157 

1.0938236  0.4920219 

1.4036706 

0 

0.00000 

2.10049 

2.04963  1.43545 

0.000 

39.47842 

0.00000 

1 

19.73921 

2.10108 

5.72302  11.55672 

0.000 

19.73921 

0.00000 

2 

9.86960 

2.10086 

3.21983  3.38258 

0.000 

19.73921 

9.86960 

3 

14.80441 

2.10098 

4.20278  5.86034 

0.000 

14.80441 

9.86960 

4 

12.37701 

2.10092 

3.66271  4.39418 

0.000 

14.80441 

12.33701 

5 

13.57071 

2.10095 

3.91883  5.05635 

0.000 

13.57071 

12.33701 

17 

13.47462 

2.10095 

3.89794  5.00013 

0.000 

13.47462 

13.47432 

18 

13.47447 

2.10095 

3.89790  5.00004 

0.000 

13.47447 

13.47432 

19 

13.47440 

2.10095 

3.89789  5.00000 

0.000 

13.47440 

13.47432 

P 

0.9334814 

0.9334814 

a  = 

1.1275842 

1.1275842 

e  = 

0.4148981 

0.4148981 

i  = 

90.0000000 

90.0000000 

Omega  = 

303.6900675 

303.6900675 

Argp  = 

95.4911977 

95.4911977 

Nu  = 

143.5271501 

323.5060831 

M  = 

106.4464590 

345.7059561 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  = 

Undefined 

Undefined 

**  Tests  two  position  vectors  which  are  almost  100  deg  apart  ** 
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GAUSS  Test  Cases  (  Continued  ) 


*7.  BMW  Example  problem  pg.  236 

R1  =  0.5000000  0.6000000  0.7000000  1.0488088 

R2  =  0.0000000  1.0000000  0.0000000  1.0000000 

Delta  time  =  0.9668000  TU  Long  Way 

V12  =  -0.6309842  -1.1143338  -0.8833778  1.5557112 

V22  =  0.1785764  1.5552874  0.2500069  1.5853429 


Iterations 

« 

z 

y 

X 

tn  vara  upper  lower 

0 

0.00000 

3.86474 

2.78020 

1.05725  -1.284  0.00000-12.56637 

1 

-6.28319 

5.48830 

2.58271 

0.91188  -1.284  0.00000  -6.28319 

2 

-3.14159 

4.62581 

2.67724 

0.97812  -1.284  -3.14159  -6.28319 

3 

-4.71239 

5.04384 

2.62895 

0.94330  -1.284  -3.14159  -4.71239 

4 

-3.92699 

4.83159 

2.65284 

0.96030  -1.284  -3.14159  -3.92699 

12 

-3.635S3 

4.75448 

2.66183 

0.96682  -1.284  -3.63553  -3.63860 

13 

-3.63707 

4.75489 

2.66179 

0.96678  -1.284  -3.63553  -3.63707 

14 

-3.63630 

4.75468 

2.66181 

0.96680  -1.284  -3.63630  -3.63707 

P 

= 

0.0943930 

0.0943930 

a 

= 

-1.9481328 

-1.9481328 

e 

= 

1.0239400 

1.0239400 

i 

= 

125.5376778 

125.5376778 

Omega 

= 

90.0000000 

90.0000000 

Argp 

= 

207.8180879 

207.8180879 

Nu 

= 

207.2866848 

152.1819121 

M 

= 

10.5153135 

9.8480705 

U 

S 

Undefined 

Undefined 

L 

= 

Undef Ined 

Undefined 

Cappi 

- 

Undefined 

Undefined 

**  Tests  Hyperbolic  case  with  negative  values  of  z  ** 


*8.  BMW  Example  problem  pg.  236 


R1 

= 

0.5000000 

0.6000000 

0.7000000 

1.0488088 

R2 

= 

0.0000000 

1.0000000 

0.0000000 

1.0000000 

Delta 

time  » 

0.9668000  TU 

Short  Way 

V12 

z 

-0.3616124 

0.7697209 

-0.5062574 

0.9897123 

V22 

= 

-0.6018279 

-0.0224179 

-0.8425591 

1.0356666 

0 

0.00000 

0.23287 

0.68246 

0.67263 

1.284 

39.47842 

0.00000 

1 

19.73921 

3.14872 

7.00602 

23.47961 

1.284 

19.73921 

0.00000 

2 

9.86960 

2.04881 

3.17970 

5.09525 

1.284 

9.86960 

0.00000 

3 

4.93480 

1.24251 

1.95412 

2.40181 

1.284 

4.93480 

0.00000 

4 

2.46740 

0.76475 

1.37366 

1.50464 

1.284 

2.46740 

0.00000 

5 

1.23370 

0.50579 

1.05940 

1.09950 

1.284 

1.23370 

0.00000 

16 

0.83311 

0.41872 

0.94768 

0.96696 

1.284 

0.83311 

0.83251 

17 

0.83281 

0.41866 

0.94759 

0.96686 

1.284 

0.83281 

0.63251 

18 

0.83266 

0.41862 

0.94755 

0.96681 

1.284 

0.83266 

0.83251 

P 

5 

1.0721027 

1.0721027 

a 

s 

1.0782895 

1.0782895 

e 

a 

0.0757470 

0.0757470 

l 

a 

54.4623222 

54.4623222 

Omega 

= 

270.0000000 

270.0000000 

Argp 

a 

197.8449338 

197.8449338 

Hu 

=■ 

287.0502935 

342.1550662 

M 

295.2054467 

344.6774129 

U 

5 

Undefined 

Undefined 

L 

= 

Undefined 

Undefined 

Cappi 

5 

Undefined 

Undefined 
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GAUSS  Taft  Caff!  (  Continual  ) 


9. 

BMW  problem  pg.  275 

#5. lib 

R1  = 

1.2000000 

0.0000000  0. 

0000000 

1.2000000 

R2  = 

0.0000000 

2.0030000  0. 

0000000 

2.0000000 

Delta  time  = 

10.0000000  TU  Short  Way 

V12  = 

0.7497686 

0.7090867  0. 

,0000000 

1.0319675 

V22  = 

-0.4254520 

-0.4661339  -0. 

,0000000 

0.6311024 

0 

0.00000 

1.00911 

1.42064  2.03409 

1.549 

39.47842 

0.00000 

1 

19.73921 

4.52702 

8.40060  39.84524 

1.549 

19.73921 

0.00000 

2 

9.86960 

3.20000 

3.97384  9.12942 

1.549 

19.73921 

9.86960 

3 

14.80441 

3.95748 

5. 76812  18.23108 

1.549 

14.80441 

9.86960 

4 

12.33701 

3.60388 

4.79715  12.81244 

1.549 

12.33701 

9.86960 

5 

11.10330 

3.40844 

4.36982  10.80249 

1.549 

11,10330 

9.86960 

19 

10.53909 

3.31475 

4.16513  10.00008 

1.549 

10.53909 

10.53901 

20 

10.53905 

3.31475 

4.18512  10.00003 

1.549 

10.53905 

10.53901 

21 

10.53903 

3.31474 

4.18511  10.00000 

1.549 

10.53903 

10.53901 

P  = 

0.7240377 

0.7240377 

a  = 

1.6219309 

1.6619309 

e  * 

0.7512253 

0.7512253 

1 

0.0000000 

0.0000000 

Omega  = 

Undefined 

Undef ined 

Argp  = 

Undefined 

Undefined 

Nu  = 

121.8693704 

211.8693704 

M  = 

28.2972591 

295.7231038 

U  = 

Undef lned 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  = 

238.1306296 

238.1306296 

*10.  BMW  problem  pg.  275  #5. lid 


R1  =  4.0000000  0.0000000  0.0000000 

R2  =  -2.0000000  0.0000000  0.0000000 

Delta  time  *  10.0000000  TU  Short  Way 


4.0000000 

2.0000000 


VI 2 
V22 


O.OOOOOUO 

0.0000000 


0. 0000000 
0.0000000 


0.0000000 

0.0000000 


0.0000000 

0.0000000 


Iterations: 

«  z  y 

Hone. 


P 

= 

Undefined 

a 

= 

Undefined 

e 

= 

Undefined 

i 

- 

Undefined 

Omega 

= 

Undefined 

Argp 

= 

Undefined 

NU 

= 

Undefined 

M 

= 

Undefined 

U 

3 

Undefined 

L 

= 

Undefined 

Cappi 

= 

Undefined 

x  tn  vara  uppar 


Undefined 
Undefined 
Undefined 
Undefined 
Undefined 
Undaf lned 
Undefined 
Undefined 

Undefined 

Undefined 

Undefined 


lower 


**  NOT  POSSIBLE  since  the  vectors  are  Co-linear,  i.e.  Nu  «  Pi  ** 
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GAUSS  Test  Cates 


(  Continued  ) 


11.  BMW  problem  pg.  275  #5. lie 


R1  = 

2.0000000 

0.0000000 

0.0000000 

2.0000000 

R2  = 

-2.0000000 

-0.2000000 

0.0000000 

2.0099751 

Delta 

time  = 

20.0000000  TU 

Long  Way 

VI 2  -- 

0.3083353 

0.7157383 

-0.0000000 

0.7793283 

V22  = 

0.3778475 

-0.6779535 

0.0000000 

0.7761377 

0 

0.00000 

4.20973 

2.90163  3.78189  -0.141 

39.47842 

0.00000 

1 

19.73921 

3.88899 

7.78614  28.82271  -0.141 

19.73921 

0.00000 

2 

9.86960 

4.00998 

4.44842  8.63618  -0.141 

19.73921 

9.86960 

3 

14.80441 

3.94091 

5.75603  14.77378  -0.141 

19.73921 

14.80441 

4 

17.27181 

3.91295 

6.65020  20.22782  -0.141 

17.27181 

14.80441 

20 ' 

17.18766 

3.91384 

6.61618  20.00007  -0.141 

17.18766 

17.18762 

21 

17.18764 

3.91384 

6.61617  20.00002  -0.141 

17.18764 

17.18762 

22 

17.18763 

3.91384 

6.61617  19.99999  -0.141 

17.18764 

17.18763 

P  = 

2.0491252 

2.0491252 

a  a 

2.5468139 

2.5468139 

e  = 

0.4420591 

0.4420591 

i 

0.0000000 

0.0000000 

Omega  = 

Undefined 

Undefined 

Argp  = 

Undefined 

Undefined 

Hu  = 

86.8147745 

272.5253677 

M  = 

38.8020471 

320.7420307 

U  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  * 

273.1852255 

273.1852255 

‘12.  BMW  problem  pg.  274  f 5 . 8 


R1 

= 

1.0000000 

0.0000000 

0.0000000 

1.0000000 

R2 

= 

1.0000000 

1.0000000 

1.0000000 

1.7320508 

Delta 

time  a 

1.0922000  TU 

Short  Way 

V12 

S 

0.3628742 

1.0086839 

1.0086839 

1.4719253 

V22 

= 

-0.2095055 

0.7991784 

0.7991784 

1.1494628 

0 

0.00000 

0.39451 

0.88827 

1.15499 

1.653 

0.00000-12.56637 

l 

-1.12642 

0.05758 

0.32393 

0.40261 

1.653 

0.00000  -1.12642 

2 

-0.56321 

0.22800 

0.65969 

0.83846 

1.653 

0.00000  -0.56321 

3 

-0.28161 

0.31174 

0.78042 

1.00322 

1.653 

0.00000  -0.28161 

4 

-0.14080 

0.35325 

0.83562 

1.08032 

1.653 

0.00000  -0.14080 

5 

-0.07040 

0.37391 

0.86223 

1.11792 

1.653 

-0.07040  -0.14080 

12 

0.11625 

0.35987 

0.84421 

1.09243 

1.653 

-0.11825  -0.11880 

13 

-0.11853 

0.35979 

0.84411 

1.09228 

1.653 

-0.11853  -0.11880 

14 

-0.11066 

0.35975 

0.84405 

1.09221 

1.653 

-0.11866  -0.11880 

P 

= 

2.0348865 

2.0348865 

a 

= 

-6.0036903 

-6.0036903 

e 

= 

1.1571254 

1.1571254 

i 

= 

45.0000000 

45.0000000 

Omega 

= 

0.0000000 

0.0000000 

Argp 

= 

333.4263200 

333.4263200 

Nu 

= 

26.5736800 

81.3092903 

H 

1.1720949 

5.4261265 

U 

- 

Undefined 

Undefined 

L 

= 

Undefined 

Undefined 

Cappi 

2 

Undefined 

Undefined 

**  Tests  Hyperbola  and  lower  bounds  on  a  negative  iteration  ** 


GAUSS  Teet  Cases 


(  Continued  ) 


*X3.  BMW  problem  pg.  274  #5.10 


R1  =  1.0000000 

0.0000000  0. 

0000000 

1.0000000 

R2  =  1.00C0000 

0.1250000  0. 

1250000 

1.0155048 

Delta  time  = 

0.1250000  TU  Short  Hay 

V12  =  0.0618607 

1.0025629  1. 

0025629 

1.4191869 

V22  =  -0.0609162 

0.9949484  0. 

9949484 

1.4083875 

Iterations: 

* 

2  y 

x  tn 

vara 

upper  lower 

0 

0.00000  0.00777 

0.12464  9.12544 

1.420 

0.00000-12.56637 

1 

-0.03070  0.00006 

0.01071  0.01076 

1.420 

0.00000  -0.03070 

2 

-0.01535  0.00391 

0.08842  0.08893 

1.420 

0.00000  -0.01535 

3 

-0.00768  0.00584 

0.10805  0.10871 

1.420 

0.00000  -0.00768 

4 

-0.00384  0.00680 

0.11664  0.11737 

1.420 

0.00000  -0.00384 

5 

-0.00192  0.00729 

0.12070  0.12147 

1.420 

0.00000  -0.00192 

11 

-0.00021  0.00771 

0.12421  0.12502 

1.420  ■ 

-0.00021  -0.00024 

12 

-0.00022  0.00771 

0.12418  0.12498 

1.420  - 

-0.00021  -0.00022 

13 

-0.00022  0.00771 

0.12420  0.12500 

1.420  - 

-0.00021  -0.00022 

p  =  2.0102648 

2.0102648 

a  =  -70.9646068 

-70.9646068 

e  =  1.0140649 

1.0140649 

i  =  45.0000000 

45.0000000 

Omega  =  0.0000000 

0.0000000 

Argp  =  3S5. 0381799 

355.0381799 

Nu  =  4.9618201 

14.9868079 

M  =  0.0058393 

0.0178196 

U  =  Undefined 

Undefined 

i  =  Undefined 

Undefined 

Cappi  *  Undefined 

Undefined 

“  Testa  first  guess  too  close  and  solution  near  sero  ** 


14.  A423  test  case 


R1  = 

1.0500000 

0.0000000  0. 

,0000000  1.0500000 

R2  = 

-3.2500000 

2.6037000  0. 

,0000000  4.1643431 

Delta 

time  - 

2.0000000  TU  Short  Way 

V12  = 

-1.7964252 

1.9359850  0. 

,0000000  2.6410569 

V22  = 

-2.1040017 

1.0601246  0. 

,0000000  2.3559897 

Iterations: 

1 

Z 

y 

x  tn 

vara  upper  lower 

0 

0.00000 

3.82866 

2.76719  5.44876 

0.980  0.00000-12.56637 

1 

-6.28319 

2.58977 

1.77414  2.84747 

0.980  -6.28319-12.56637 

2 

-9.42478 

1.84751 

1.33487  1.96246 

0.980  -6.28319  -9.42478 

3 

-7.85398 

2.22959 

1.55259  2.38257 

0.980  -7.85398  -9.42478 

4 

-8.63938 

2.04134 

1.44353  2.16772 

0.980  -8.63938  -9.42478 

5 

-9.03208 

1.94513 

1.38919  2.06399 

0.980  -9.03208  -9.42478 

13 

-9.27905 

1.88390 

1.35503  1.99989 

0.980  -9.27752  -9.27905 

14 

-9.27828 

1.88409 

1.35514  2.00009 

0.980  -9.27828  -9.27905 

15 

-9.27867 

1.88399 

1.35508  1.99999 

0.960  -9.27828  -9.27867 

P  = 

4.1322119 

4.1322119 

a  = 

-0.1972223 

-0.1972223 

e  = 

4.6853013 

4.6853013 

i  = 

0.0000000 

0.0000000 

Omega  = 

Undefined 

Undefined 

Argp  s 

Undefined 

Undefined 

Hu  =  : 

308.7939154 

90.0943554 

m  =  : 

196.7341763 

30.3576180 

u  = 

Undefined 

Undefined 

L  = 

Undefined 

Undefined 

Cappi  = 

51.2060846 

51.2060846 
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GAUSS  Test  Case* 


{  Continued  ) 


15.  A423  Test  Case 


R1  3  1. 0500000 

R2  =  0.0000000 

Delta  time  3 


0.0000000  0.0000000 

0.9000000  0.0000000 

35.0000000  TU  Short  Way 


1.0500000 

0.9000000 


V12  3  1.1418714  0.5381541  0.0000000 

V22  =  -0.6278465  -1.2315637  -0.0000000 


1.2623312 

1.3823677 


Iterations: 


1 

Z 

y 

x  tn 

vara 

upper 

lower 

0 

0.00000 

0.57523 

1.07259  0.94295 

0.972 

39.47842 

0.00000 

1 

19.73921 

2.78270 

6.58624  19.23557 

0.972 

39.47842 

19.73921 

2 

29.60881 

3.20479 

16.85862  185.74593 

0.972 

29.60881 

19.73921 

3 

24.67401 

3.03779 

10.01135  50.28323 

0.972 

24.67401 

19.73921 

4 

22.20661 

2.92211 

8.05544  30.19576 

0.972 

24.67401 

22.20661 

5 

23.44031 

2.98281 

8.95836  38.63162 

0.972 

23.44031 

22.20661 

22* 

22.95547 

2.95965 

8.58749  35.00001 

0.972 

22.95547 

22.95546 

23 

22.95546 

2.95965 

8.58749  34.99998 

0.972 

22.95547 

22.95546 

24 

22.95547 

2.95965 

8.58749  34.99999 

0.972 

22.95547 

22.95547 

P  = 

0.3192949 

0.3192949 

a  3 

3.2125232 

3.2125232 

e  3 

0.9490044 

0.9490044 

l 

0.0000000 

0.0000000 

Omega  3 

Undefined 

Undefined 

Argp  3 

Undefined 

Undefined 

Nu  3 

137.1641835 

227.1641835 

H  3 

6.4927409 

354.7668629 

U  3 

Undefined 

Undefined 

L  3 

Undefined 

Undefined 

Cappl  3 

222.8358165 

222.8358165 

16, 

A423  Test  Case 

R1  3 

1.0500000 

0.0000000  0. 

,0000000 

1.0500000 

R2  3 

-3.2500000 

2.6037000  0.0000000 

4.1643431 

Delta  < 

time  3 

10.0000000  TU  Short  Way 

V12  3 

0.2035271 

1.2213287  0. 

,0000000 

1.2381709 

V22  3 

-0.2840267 

-0.1670384  -0. 

,0000000 

0.3295042 

Iterations: 

« 

Z 

y 

x  tn 

vara 

upper 

lower 

0 

0.00000 

3.82866 

2.76719  5.44876 

0.980 

39.47842 

0.00000 

1 

19.73921 

6.0536S 

9.71433  58.92834 

0.980 

19.73921 

0.00000 

2 

9.86960 

5.21434 

5.07265  15.46269 

0.980 

9.86960 

0.00000 

3 

4.93480 

4.59908 

3.75957  9.01247 

0.980 

9.86960 

4.93480 

4 

7.40220 

4.92488 

4.36568  11.72713 

0.980 

7.40220 

4.93480 

5 

6.16850 

4.76667 

4.05153  10.26622 

0.980 

6.16850 

4.93480 

19 

5.92160 

4.73389 

3.99141  9.99998 

0.980 

5.92167 

5.92160 

20 

5.92163 

4.73389 

3.99142  10.00002 

0.980 

5.92163 

5.92160 

21 

5.92162 

4.73389 

3.99141  10.00000 

0.980 

5.92162 

5.92160 

P  = 

1.6445373 

1.6445373 

a  3 

2.6903791 

2.6903791 

e  3 

0.6234854 

0.6234654 

l 

0.0000000 

0.0000000 

Omega  3 

Undefined 

Undefined 

Argp  3 

Undefined 

Undefined 

Nu  3 

24.7473677 

166.0478077 

H  3 

4.5968877 

134.4351016 

U  3 

Undefined 

Undefined 

L  3 

Undefined 

Undefined 

Cappi  3  : 

335.2526323 

335.2526323 
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PKEPLER  Text  Cases 


1.  A423  test  case 
Initial  Target  location  : 


Ro  = 

-3.25000000 

2.60370000 

0.00000000 

4.16434313 

Vo  = 

-0.30640000 

■0.38240000 

0.00000000 

0.49001094 

Dt  = 

10.0000000000000 

TU 

Final  Target  location  : 

R2  = 

-3.65171978  - 

-2.00172677 

0.00000000 

4.16436879 

V2  = 

0.23556336 

-0.42967158 

0.00000000 

0.49000792 

P 

=  4.16394100 

4.16394100 

a 

=  4.16394100 

4.16394100 

e 

=  0.00011993 

0.00011993 

i 

=  0.00000000 

0.00000000 

Omega 

3  ************** 

Argp 

*** 

Nuo 

=  143.63583857 

211.05887378 

H 

=  143.62768933 

211.06596478 

U 

=  ************** 

Ii 

CapPi 

=  357.66460145 

357.67091784 

-  GAUSS  - 

— 

Interceptor  Position 

R1  = 

1.05000000 

0. 00000000 

0.00000000 

1.05000000 

Final  Target  Position 

r»2  = 

-3.65171978 

-2.00172677 

0.00000000 

4.16436879 

Delta  time  »  10.0000000000000  Short  Way 


Iterations  t 


Z 

y 

X 

tn 

vara 

Upper  z 

Lower  z 

0 

0.00000 

4.17679 

2.89026 

5.52343 

0.73368 

39.47842 

0.00000 

1 

19.73921 

5.84283 

9.54368 

55.36444 

0.73368 

19.73921 

0.00000 

2 

9.86960 

5.21437 

5.07266 

14.90071 

0.73368 

9.86960 

0.00000 

3 

4.93480 

4.75367 

3.82223 

8.86219 

0.73368 

9.86960 

4.93480 

4 

7.40220 

4.99762 

4.39781 

11.40528 

0.73368 

7.40220 

4.93480 

5 

6.16850 

4.87916 

4.09906 

10.03697 

0.73361 

6.16850 

4.93480 

6 

5.55165 

4.81731 

3.95806 

9.42764 

0.73368 

6.16850 

5.55165 

7 

5.86008 

4.84845 

4.02790 

9.72656 

0.73368 

6.16850 

5.86008 

8 

6.01429 

4.86386 

4.06331 

9.88030 

0.73368 

6.16850 

6.01429 

9 

6.09140 

4.87152 

4.08114 

9.95826 

0.73366 

6.16850 

6.09140 

10 

6.12995 

4.87534 

4.09009 

9.99752 

0.73368 

6.16850 

6.12995 

11 

6.14923 

4.87725 

4.09457 

10.01722 

0.73368 

6.14923 

6.12995 

12 

6.13959 

4.87630 

4.09233 

10.00737 

0.73368 

6.13959 

6.12995 

13 

6.13477 

4.87582 

4.09121 

10.00244 

0.73368 

6.13477 

6.12995 

14 

6.13236 

4.87558 

4.09065 

9.99998 

0.73368 

6.13477 

6.13236 

15 

6.13356 

4.87570 

4.09093 

10.00121 

0.73368 

6.13356 

6.13236 

16 

6.13296 

4.87564 

4.09079 

10.00060 

0.73368 

6.13296 

6.13236 

17 

6.13266 

4.87561 

4.09072 

10.00029 

0.73368 

6.13266 

6.13236 

18 

6.13251 

4.87560 

4.09069 

10.00014 

0.73368 

6.13251 

6.13236 

19 

6.13243 

4.87559 

4.09067 

10.00006 

0.73368 

6.13243 

6.13236 

20 

6.13240 

4.87559 

4.09066 

10.00002 

0.73368 

6.13240 

6.13236 

21 

6.13238 

4.87558 

4.09065 

10.00000 

0.73368 

6.13238 

6.13236 

Transfer  orbit  velocities  i 

Vlt  =  0.10732319  -1.23562515  0.00000000  1.24027730 
V2t  =  -0.26316944  0.21102745  0.00000000  0.33732883 


P 

a 

e 

i 


Omega 

Argp 

Nuo 

H 

U 

L 

CapPi 


2.72870561 

2.72870561 
0.61897296 
180.00000000 
tltttltlXOH 
it ************ 

13.00030198 

2.41894132 

************** 

************** 

346.99969802 


2.72870561 

2.72870561 

0.61897296 

180.00000000 

************** 

164.27051036 

129.53127945 

346.99969802 


If  the  velocity  of  the  Interceptor  la 

VI  =  0.00000000  0.97590000  0.00000000  0.97590000 


DeltaVl  =  Vlt  -  VI  -  0.10732319  -2.21152515  0.00000000  2.21412776 


DeitaV2  =  V?  -  V2t  =  0.49873280  -0.64069902  0.00000000  0.81192958 
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PKEPLER  Test  Cases  (  Continued  ) 

2.  A423  test  case 
Initial  Target  location  t 

Ro  =  -3.25000000  2.60370000  0.00000000  4.16434313 

Vo  =  -0.30640000  -0.38240000  0.00000000  0.49001094 

Dt  =  2.00000000000000  TU 

Final  Target  location  i 

R2  =  -3.76764653  1.77400005  0.00000000  4.16440110 

V2  =  -0.20875833  -0.44331027  0.00000000  0.49000412 

p  =  4.16394100  4.16394100 

a  =  4.16394100  4.16394100 

e  =  0.00011993  0.00011993 

1  =  0.00000000  0.00000000 
Omega  =  **************  ************** 

Argp  =  **************  ************** 

Nuo  =  143.63583857  157.12068816 

M  =  143.62768933  157.11534442 

U  a  **************  ************** 

l  a  **************  ************** 

CapPi  =  357.66460145  357.66586473 

-  GAUSS  - 

Interceptor  Position 

R1  s  1.05000000  0.00000000  0.00000000  1.05000000 

Final  Target  Position 

R2  =  -3.76764653  1.77400005  0.00000000  4.16440110 

Delta  time  =  2.00000000000000  Short  Way  ^ 

Iterations  i 


Z 

y 

X 

tn 

vara  Upper  s  Lower  z 

0 

0.00000 

4.30161 

2.93313 

5.54438 

0.64544  0.00000  -12.56637 

1 

-6.28319 

3.48552 

2.05822 

3.18899 

0.64544  -6.28319  -12.56637 

2 

-9.42478 

2.99657 

1.70004 

2.42000 

0.64544  -9.42478  -12.56637 

3 

-10.99557 

2.72987 

1.53469 

2.10002 

0.64544  -10.99557  -12.56637 

4 

-11.78097 

2.59072 

1.45474 

1.95286 

0.64544  -10.99557  -11.78097 

5 

-11.38827 

2.66079 

1.49451 

2.02546 

0.64544  -11.38827  -11.76097 

6 

-11.58462 

2.62588 

1.47458 

1.98893 

0.64544  -11.38827  -11.58462 

7 

-11.48645 

2.64336 

1.48453 

2.00714 

0.64544  -11.48645  -11.58462 

8 

-11.53554 

2.63463 

1.47955 

1.99802 

0.64544  -11.48645  -11.53554 

9 

-11.51099 

2.63900 

1.48204 

2.00257 

0.64544  -11.51099  -11.53554 

10 

-11.52326 

2.63681 

1.48080 

2.00029 

0.64544  -11.52326  -11.53554 

11 

-11.52940 

2.63572 

1.48017 

1.99916 

0.64544  -11.52326  -11,52940 

12 

-11.52633 

2.63627 

1.48049 

1.99973 

0.64544  -11.52326  -11.52633 

13 

-11.52480 

2.63654 

1.48064 

2.00001 

0.64544  -11.52480  -11.52633 

14 

-11.52556 

2.63640 

1.48056 

1.99987 

0.64544  -11.52480  -11.52556 

15 

-11.52518 

2.63647 

1.48060 

1.99994 

0.64544  -11.52480  -11.52518 

16 

-11.52499 

2.63651 

1.48062 

1.99997 

0.64544  -11.52480  -11.52499 

17 

-11.52489 

2.63652 

1.48063 

1.99999 

0.64544  -11.52480  -11.52489 

Transfer  orbit  velocities  i 

VIC  =  -2.08117693  1.69270886  0.00000000  2.68264062 

V2t  =  -2.32085567  0.62103856  0.00000000  2.40251117 

p  =  -0.18897166  -0.18897166 

a  =  -0.18897166  -0.18897166 

e  =  4.20910234  4.20910234 

1  =  0.00000000  0.00000000 
Omega  =  **«**t********  ************** 

Argp  s  **************  ************** 

Nuo  =  298.50130289  93.28835579 

H  =  230.01866192  1161.08942741 

U  a  **************  ************** 

L  a  **************  ************** 

CapPi  =  61.49819711  61.49819711 

If  the  velocity  of  the  interceptor  is 

VI  =  0.00000000  0.97590000  0.00000000  0.97590000 

DeltaVl  =  Vlt  -  VI  =  -2.08117693  0.71680886  0.00000000  2.20116159 

DeltaV2  =  V2  -  V2t  =  2.11209734  -1.06434883  0.00000000  2.36512021 
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PKEPLER  Test  Casts  {  Continued  ) 


3.  A423  test  case 
Initial  Target  location  i 

Ro  =  -3.25000000  2.60370000  0.00000000  4.16434313 

Vo  =  -0.30640000  -0.38240000  0.00000000  0.49001094 

Dt  =  35.0000000000000  TU 

Final  Target  location  t 

R2  =  3.97397194  1.24178724  0.00000000  4.16347073 

V2  =  -0.14616128  0.46781218  0.00000000  0.49011351 

p  =  4.16394100  4.16394100 

a  =  4.16394100  4.16394100 

e  =  0.00011993  0.00011993 

i  =  0.00000000  0.00000000 

Omega  -  **************  ************** 

Argp  =  **************  ************** 

Nuo  =  143.63583857  19.66627822 

M  =  143.62768933  19.66165341 

U  =  **************  ************** 

k  -  **************  ************** 

CapPl  =  357.66460145  357.68670880 

-  GAUSS  - 

Interceptor  Position 

R1  =  1.05000000  0.00000000  0.00000000  1.05000000 

Final  Target  Position 

R2  =  3.97397194  1.24178724  0.00000000  4.16347073 

Delta  time  =  35.0000000000000  Short  Way 


Iterations  s 


Z 

y 

X 

tn 

vara 

Upper  x 

Lower  z 

0 

0.00000 

1.07963 

1.46944 

3.56604 

2.92307 

39.47842 

0.00000 

1 

19.73921 

7.71734 

10.96827 

89.47046 

2.92307 

19.73921 

0.00000 

2 

9.86960 

5.21347 

5.07222 

19.89619 

2.92307 

19.73921 

9.86960 

3 

14.80441 

6.64271 

7.47304 

40.47799 

2.92307 

14.80441 

9.86960 

4 

12.33701 

5.97553 

6.17712 

28.22152 

2.92307 

14.80441 

12.33701 

5 

13.57071 

6.32058 

6.79714 

33.73129 

2.92307 

14.80441 

13.57071 

6 

14.18756 

6.48446 

7.12753 

36.92987 

2.92307 

14.18756 

13.57071 

7 

13.87913 

6.40323 

6.96052 

35.28964 

2.92307 

13.87913 

13.57071 

8 

13.72492 

6.36208 

6.87839 

34.50055 

2.92307 

13.87913 

13.72492 

9 

13.80202 

6.38270 

6.91934 

34.89258 

2.92307 

13.87913 

13.80202 

10 

13.84058 

6.39298 

6.93990 

35.09048 

2.92307 

13.84058 

13.80202 

il 

13.82130 

6.38784 

6.92962 

34.99137 

2.92307 

13.84058 

13.82130 

12 

13.83094 

6.39041 

6.93476 

35.04088 

2.92307 

13.83094 

13.82130 

13 

13.82612 

6.38913 

6.93219 

35.01612 

2.92307 

13.82612 

13.82130 

14 

13.82371 

6.38848 

6.93090 

35.00374 

2.92307 

13.82371 

13.82130 

15 

13.82251 

6.38816 

6.93026 

34.99756 

2.92307 

13.82371 

13.82251 

16 

13.82311 

6.38832 

6.93058 

35.00065 

2.92307 

13.82311 

13.82251 

17 

13.82281 

6.38824 

6.93042 

34.99910 

2.92307 

13.82311 

13.82281 

18 

13.82296 

6.38828 

6.93050 

34.99988 

2.92307 

13.82311 

13.82296 

19 

13.82303 

6.38830 

6.93054 

35.00026 

2.92307 

13.82303 

13.82296 

20 

13.82300 

6.38829 

6.93052 

35.00007 

2.92307 

13.82300 

13.82296 

21 

13.82298 

6.38829 

6.93051 

34.99997 

2.92307 

13.82300 

13.82298 

22 

13.82299 

6.38829 

6.93052 

35.00002 

2.92307 

13.82299 

13.82298 

23 

13.82298 

6.38829 

6.93051 

35.00000 

2.92307 

13.82299 

13.82298 

Transfer  orbit  velocities  i 

Vlt  =  1.26044599  0.16808010  0.00000000  1.27160333 

V2t  =  -0.42955162  -0.08981634  0.00000000  0.43884117 

p  *  3.47479351  3.47479351 

a  =  3.47479351  3.47479351 

e  =  U. 99550811  0.99550811 

i  =  0.00000000  0.00000000 

Omega  -  **************  ************** 

Argp  s  **************  ************** 

Nuo  =  167.08810965  184.44109668 

M  =  4.81579179  314.41306557 

U  -  **************  ************** 

L  =  **************  ************** 

CapPi  =  192.91189035  192.91189035 

If  the  velocity  of  the  Interceptor  is 

Vi  =  0.00000000  0.97590000  0.00000000  0.97590000 

DeltaVl  =  Vlt  -  VI  =  1.26044599  -0.80781990  0.00000000  1.49709622 

Del taV2  =  V2  -  V2t  =  0.28339034  0.55762852  0.00000000  0.62550751 


iJKtoLatLom 


i  j  k 

r  =  1.125  0.784  1.372  DU  JD  =  2446086.7835 

Geocentric  Latitude  =  44.923 

Longitude  *  -168.059 


SUN 


Date 

Time 

Rt  Aac  Declination 

X 

y 

z 

Magnitude 

7 

Mar  1960 

Oi 

0i 

0.00 

347.5098316  -5. 3581087 

0.9647718 

-0.2137111 

-0.0926796 

0.9924951 

1 

Jan  1987 

Oi 

Oi 

0.00 

280.9058053  -23.0621533 

0.1711689 

-0.8683825 

-0.3851906 

0.9833077 

* 

0.1742717 

-0.8878979 

-0.3849824 

0.9833335 

14 

May  1987 

Oi 

Oi 

0.00 

50.2799618  18.4437210 

0.6126212 

0.7373809 

0.3197175 

1.0105714 

* 

50.2831665  18.4464166 

0.6099669 

0.7391757 

0.3204954 

1.0105234 

7 

Dec  1987 

0: 

Oi 

0.00 

253.0019878  -22.5209713 

-0.2660578 

-0.8703439 

-0.3773668 

0.9852365 

* 

-0.2632428 

-0.8710383 

-0.3776657 

0.9852085 

1 

Jan  1988 

Oi 

Ot 

0.00 

280.6376087  -23.0804049 

0.1669865 

-0.0890567 

-0.3854802 

0.9833114 

* 

0.1698618 

-0.8885706 

-0.3852661 

7 

Jan  1989 

Ot 

Oi 

0.00 

288.0699572  -22.4012346 

0.2819902 

-0.8642844 

-0.3747367 

0.9833278 

* 

288.0718324  -22.4032777 

0.2846084 

-0.8635956 

-0.3744404 

7 

Sep  1989 

Ot 

Ot 

0.00 

165.5883823  6.1590506 

-0.9703890 

0.2493633 

0.1081185 

1.0077333 

* 

165.5914994  6.1511388 

-0.9711011 

0.2470317 

0.1071008 

27 

Oct  1989 

Oi 

Oi 

0.00 

211.3147039  -12.6993087 

-0.8282793 

-0.5038929 

-0.2184768 

0.9938244 

* 

211.3141660  -12.7006667 

-0.8269128 

-0.5058353 

-0.2193263 

MOON 


7 

Date 

Mar  1960 

Oi 

Time 

Ot  0.00 

Rt  Asc  Declination 

93.2827108  18.1740408 

X 

-3.4450973 

y 

60.0642320 

X 

19.7498143 

Magnitude 

63.3200725 

1 

Jan 

1987 

Oi 

Oi 

0.00 

295.0571035  -26,4619655 

21.3030552 

-45.5659292 

-25.0362158 

56.1849453 

14 

May 

1987 

Oi 

Oi 

0.00 

235.9616350  -23.6405903  -29.4768585 
235.8341659  -23.6722222 

-43.6381820 

-23.0509295 

57.4838850 

7 

Dec 

1987 

Oi 

Oi 

0.00 

93.8507651  21.3624008 

93.8729164  21.3913889 

-3.6947803 

54.8920738 

29.6995740 

62.5192520 

1 

Jan 

1988 

Oi 

Oi 

0.00 

62.0701366  25.7416698 

26.0736204 

49.1824943 

26.8396283 

61.7977078 

1 

Jan 

1989 

Oi 

0: 

0.00 

196.2814860  -10.6881272  -59.4985477 
196.3591660  -10.7161111 

-17.3777252 

-11.6987324 

63.0785260 

7 

Sep 

1989 

Oi 

Oi 

0.00 

235.0997646  -24.9640899  - 
235.0529159  -24.9547222 

■32.7168135 

-46.8980417 

-26.6446131 

63.0840945 

27 

Oct 

1989 

Oi 

Oi 

0.00 

183.1455367  -4.9906999  - 

-63.1781196 

-3.4730719 

-5.5253C44 

63.5142858 

183.1216661  -4.9911111 
*  Astronomical  Almanac  Value* 


vINRlseSet 

JDate 

Day 

Mon 

Yr 

Lat 

SunRlae 

Sunset 

hr 

min 

hr 

■In 

2448258.5 

2 

Jan 

91 

40.0 

7 

22 

16 

46 

2448430.5 

23 

Jun 

91 

40.0 

4 

32 

19 

33 

2448430.5 

23 

Jun 

91 

64.0 

1 

31 

22 

33 

2448438.5 

1 

JUl 

91 

-55.0 

8 

26 

15 

41 

2448614.5 

24 

Doc 

91 

40.0 

7 

19 

16 

39 
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MISC  I  CBM  Test  Cases 


PATH  and  RNGAZ  Test  Cases 


0.0000000 

0.0000000 

1000.0000000 

169.8570000 

-8.8416236 

1.5946625 

0.0000000 

0.0000000 

0.0000000 

169.8570000 

0.0000000 

0.0000000 

0.0000000 

0.0000000 

0.0000000 

0.0000000 

0.0000000 

0.0000000 

0.0000000 

o.ooooooo 

10.0000000 

0.0000000 

0.0898315 

0.0000000 

0.0000000 

0.0000000 

10.0000000 

90.0000000 

-0.0000000 

0.0898315 

0.0000000 

0.0000000 

10.0000000 

180.0000000 

-0.0898315 

0.0000000 

0.0000000 

0.0000000 

10.0000000 

270.0000000 

0.0000000 

359.9101685 

0.0000000 

0.0000000 

1536,6540000 

270.0000000 

0.0000000 

346.1942054 

0.0000000 

0.0000000 

6370.0000000 

270.0000000 

0.0000000 

302.7773155 

0.0000000 

0.0000000 

6370.0000000 

160.0000000 

-57.2226845 

0.0000000 

0.0000000 

0.0000000 

6370.0000000 

90.0000000 

-0.0000000 

57.2226845 

0.0000000 

0.0000000 

6370.0000000 

0.0000000 

57.2226845 

0.0000000 

0.0000000 

0.0000000 

6000.0000000 

0.0000000 

71.8652238 

0.0000000 

0.0000000 

0.0000000 

8000.0000000 

90.0000000 

-0.0000000 

71.8652238 

0.0000000 

0.0000000 

8000.0000000 

180.0000000 

-71.8652238 

360.0000000 

0.0000000 

0.0000000 

6000.0000000 

270.0000000 

0.0000000 

288.1347762 

-20.0000000 

0.0000000 

8000.0000000 

270.0000000 

-6.1109959 

287.1068112 

-20.0000000 

0.0000000 

6000.0000000 

270.0000000 

-11.6259897 

304.4213918 

-20.0000000 

0.0000000 

6000.0000000 

180.0000000 

-73.8989179 

0.0000000 

-20.0000000 

0.0000000 

6000.0000000 

90.0000000 

-11.6259897 

55.5786082 

-20.0000000 

0.0000000 

6000.0000000 

90.0000000 

-11.6259897 

55.5786082 

-20.0000000 

0.0000000 

6000.0000000 

0.0000000 

33.8989179 

0.0000000 

30.0000000 

0.0000000 

6000.0000000 

0.0000000 

83.8989179 

0.0000000 

30.0000000 

0.0000000 

6000.0000000 

90.0000000 

17.1339014 

57.7258837 

30.0000000 

0.0000000 

6000.0000000 

180.0000000 

-23.8989179 

0.0000000 

30.0000000 

0.0000000 

6000.0000000 

270.0000000 

17.1339014 

302.2741163 

66.0000000 

0.0000000 

6000.0000000 

270.0000000 

35.9993679 

272.9120869 

66.0000000 

0.0000000 

6000.0000000 

180.0000000 

32.1010821 

0.0000000 

66.0000000 

0.0000000 

6000.0000000 

270.0000000 

35.9993679 

272.9120869 

86.0000000 

0.0000000 

6000.0000000 

90.0000000 

35.9993679 

87.0879131 

86.0000000 

-100.0000000 

6000.0000000 

90. 0000000 

35.9993679 

347.0879131 

86.0000000 

-100.0000000 

6000.0000000 

0.0000000 

40.1010821 

80.0000000 

66.0000000 

-100.0000000 

6000.0000000 

180.0000000 

32.1010821 

260.0000000 

86.0000000 

-100.0000000 

6000.0000000 

270.0000000 

35.9993679 

172.9120869 

86.0000000 

140.0000000 

6000.0000000 

270.0000000 

35.9993679 

52. 9120869 

86.0000000 

140.0000000 

6000.0000000 

180.0000000 

32.1010821 

140.0000000 

86.0000000 

140.0000000 

6000. 0000000 

90.0000000 

35.9993679 

227.0879131 

86.0000000 

140.0000000 

6000.0000000 

0.0000000 

40.1010821 

320.0000000 

GEOCENTRIC  and  INVCEOCENTRIC  Teat  Casas 

Geocentric  Latitude  Deg  Geodetic  Latitude  Deg 

-20.0000  0.0000 
0.0000 
10.0000 
20.0000 
50.0000 
70.0000 
90.0000 

T RAJ EC  Test  Cases 

Alt  of  burnout  0.0  ft 


Latitudes 

Longitudes 

0 

Type  Trajectory 

47.3000000 

43.3000000 

-111.1600000 

61.0000000 

0.870000 

High 

89.3649491 

34.6748938 

42.7266242 

357.9239768 

9948.0604758 

Range  in  deg  and  km 
Flight  Path  Angle  deg 
Tiste  of  Flight  min 
Ailmuth  deg 

-136.2692682 

7.3897206 

4.2029324 

2.4294622 

Influence  Coefficients 
Needed  velocity  km/s 

47.3000000 

43.3000000 

-111.1600000 

61.0000000 

0.870000 

Low 

89.3907074 

10.6511053 

25.4576416 

1.0690019 

9950,9278763 

Range  in  deg  and  km 
Flight  Path  Angle  deg 
Time  of  Flight  min 
Asiauth  deg 

350.6706321 

7.3745838 

10.83078S1 

6.2606248 

Influence  Coefficients 
Needed  velocity  km/s 

PREDICT  TEST  Casts 


Epoch  Data  <  Sits  Data  <  Tims  Data  : 

2447776.500  76.570  Latitude  2447826.50 

12.53536954  n  rev/day  -68.270  Longitude  2900.00  min 

0.00243456  ndot  rsv/2day2  2519.685  Altitude  ft  2.00  nin 

0.1604069  e 

-0.000232  edot  /day 

74.4536  i 

325.0201  omega  deg 

-1.8465  omega  dot  deg/day 

324.6788  argp  deg 

-4.5783  argp  dot  deg/day 

36.84884  M  dag 

NOTE 1 1  These  results  are  produced  using  the  Dot  terms  above.  If  the  user 

calculates  their  own  terms,  secular,  J2  only,  the  values  will  differ 
substantially. 

Universal 


Results: 

Range  km 

As 

El 

JD 

Hr 

Min  Sec 

Eye 

1859.5720 

267.10873 

0.30459 

2447826.5000000 

27 

Oct 

1989 

0 

0 

:  0.00 

Eye 

926.2845 

259.58111 

10.93659 

2447826.5013889 

27 

Oct 

1989 

0 

1 

<60.00 

Radar 

Nlte 

339.4721 

161.27447 

39.40792 

2447826.5027778 

27 

Oct 

1989 

0 

3 

<60.00 

Radar 

Nlte 

1121.4410 

107.98459 

6.52213 

2447826.5041667 

27 

Oct 

1989 

0 

5 

<60.00 

Radar 

Nlte 

1102.1904 

276.54812 

6.96616 

2447826.5805556 

27 

Oct 

1989 

1 

55 

<60.00 

Radar 

Nlte 

527.8062 

212.73884 

22.42525 

2447826.5819444 

27 

Oct 

1989 

1 

57 

<60.00 

Radar 

Nlte 

1110.4456 

149.72838 

7.27938 

2447826.5833333 

27 

Oct 

1989 

1 

59 

<60.00 

Radar 

Nlte 

1360.2813 

281.27566 

3.29773 

2447826.6597222 

27 

Oct 

1989 

3 

49 

<60.00 

Radar 

Nlte 

1052.6357 

235.28395 

7.84189 

2447826.6611111 

27 

Oct 

1989 

3 

51 

<60.00 

Radar 

Nlte 

1500.7202 

194.69278 

3.08922 

2447826.6625000 

27 

Oct 

1989 

3 

53 

<60.00 

Eye 

1886.4860 

208.55513 

1.10362 

2447827.3597222 

27 

Oct 

1989 

20 

37 

<60.00 

Eye 

1042.6527 

190.39413 

9.95337 

2447827.3611111 

27 

Oct 

1989 

20 

39 

<60.00 

Eye 

680.8354 

123.13483 

16.93138 

2447827.3625000 

27 

Oct 

1989 

20 

41 

<60.00 

Radar 

NltO 

1312.6565 

77.08573 

3.86010 

2447827.3638889 

27 

Oct 

1989 

20 

43 

<60.00 

Eye 

1641.6349 

246.99227 

0.43637 

2447827.4388889 

27 

Oct 

1989 

22 

31 

<60.00 

Eye 

914.5342 

237.96272 

11.15685 

2447827.4402778 

27 

Oct 

1989 

22 

33 

<60.00 

Radar 

Nlte 

373.8777 

141.10461 

34.85709 

2447827.4416667 

27 

Oct 

1989 

22 

35 

<60.00 

Radar 

Nlte 

1152.6843 

90.65242 

6.09810 

2447827.4430556 

27 

Oct 

1989 

22 

37 

<60.00 

Eye 

1027.5726 

267.99792 

8.15068 

2447827.5194444 

28 

Oct 

1989 

0 

27 

<60.00 

Radar 

Nlte 

354.0547 

193.22169 

37.15572 

2447827.5208333 

28 

Oct 

1989 

0 

29 

<60.00 

Radar 

Nlte 

1039.8861 

120.66774 

8.51512 

2447827.5222222 

28 

Oct 

1989 

0 

31 

<60.00 

Radar 

Nlte 

1198.6142 

279.81762 

5.30112 

2447827.5986111 

28 

Get 

1989 

2 

21 

<60.00 

Radar 

Nlte 

670.7525 

224.68996 

17.03599 

2447827.6000000 

28 

Oct 

1989 

2 

23 

<60.00 

Radar 

Nlto 

1161.3700 

166.35389 

7.62851 

2447827.6013889 

28 

Oct 

1989 

2 

25 

<60.00 

Radar 

Nlte 

1489.1514 

282.25136 

2.06140 

2447827.6777778 

28 

Oct 

1989 

4 

15 

<60.00 

Radar 

Nlte 

1282.9142 

241.62790 

5.37061 

2447827.6791667 

28 

Oct 

1989 

4 

17 

<60.00 

Radar 

Nlte 

1715.6553 

207.31945 

1.98473 

2447827.6805556 

28 

Oct 

1989 

4 

19 

<60.00 

Eye 

1672.9835 

220.33454 

1.66571 

2447828.3777778 

23 

Oct 

1S89 

21 

3 

<60.00 

Eye 

812.2532 

199.89954 

13.10451 

2447828.3791667 

28 

Oct 

1989 

21 

5 

<60.00 

Eye 

627.2100 

110.81914 

17.87177 

2447828.3805556 

28 

Oct 

1989 

21 

7 

<60.00 

Radai 

Nite 

1419.3929 

77.37957 

2.93510 

2447828.3819444 

28 

Oct 

1989 

21 

9 

<60.00 

Eye 

1682.0727 

256.64734 

0.75375 

2447828.4569444 

28 

Oct 

1989 

22 

57 

<60.00 

Eye 

755.2339 

246.17602 

13.81707 

2447828,4583333 

28 

Oct 

1989 

22 

59 

<60.00 

Radar 

Nite 

431.7184 

124.77448 

29.32401 

2447828.4597222 

28 

Oct 

1989 

23 

1 

<60.00 

Radar 

Nite 

1297.7978 

96.46179 

5.07336 

2447828.4611111 

28 

Oct 

1989 

23 

3 

<60.00 

Radar 

Nite 

880.3825 

268.53985 

10.67522 

2447828.5375000 

29 

Oct 

1989 

0 

53 

<60.00 

Radar 

Nite 

468.2274 

174.96352 

28.18420 

2447828.5388889 

29 

Oct 

1989 

0 

55 

<60.00 

Radar 

Nite 

1240.7851 

130.96218 

7.02184 

2447828.5402778 

29 

Oct 

1989 

0 

57 

<60.00 

Radar 

Nite 

1106.6630 

273.05680 

7.07086 

2447828.6166667 

29 

Oct 

1989 

2 

47 

<60.00 

Radar 

Nite 

881.1470 

214.51822 

13.07541 

2447828.6180556 

29 

Oct 

1989 

2 

49 

<60.00 

Radar 

Nlte 

1480.5495 

175.31319 

5,24977 

2447828.6194444 

29 

Oct 

1989 

2 

51 

<60.00 

Radar 

Nite 

1549.6968 

273.81067 

2.29647 

2447828.6958333 

29 

Oct 

1989 

4 

41 

<60.00 

Radar 

Nlte 

1610.6864 

237.78891 

3.14410 

2447828.6972222 

29 

Oct 

1989 

4 

43 

<60.00 

E-33 


PREDICT  TE8T  Cases  Continued 


Epoch  Data  t 

Site  Data  i 

Time  Data  t 

2447610.6917756 

39.004  Latitude 

2447616.50 

15.65140042 

n 

rev/day  - 

■104.883  Longitude 

2900.00  min 

0.00057550 

ndot 

rev/2day2 

7219.000  Altitude  It 

2,00  min 

0.0018756 

e 

-0.0000489 

•dot 

/<J»y 

51.6244 

i 

72.1636 

omega 

deg 

-5.0693 

omega  dot  deg/day 

32.7752 

argp 

deg 

3.7850 

argp  dot 

deg/day 

327.44680 

M 

dag 

FOR  Soviet  Space  Station  HIR 

GMT  Time 

Results:  Range  km 

A* 

K1 

JD 

Hr  Min  Sec 

Radar 

Sun 

1557.3661 

0.00000 

0.00000 

2447616.5083333 

31 

Mar 

1989 

0 

11 

60.00 

Radar 

Sun 

776.7879 

0.00000 

0.00000 

2447616.5097222 

31 

Mar 

1989 

0 

13 

60.00 

Radar 

Sun 

506.6204 

0.00000 

0.00000 

2447616.5111111 

31 

Mar 

1989 

0 

15 

60.00 

Radar 

Sun 

1178.9451 

0.00000 

0.00000 

2447616.5125000 

31 

Mar 

1989 

0 

17 

60.00 

Radar 

Sun 

1995.5339 

0.00000 

'  0.00000 

2447616.5138869 

31 

Mar 

1989 

0 

19 

60.00 

Eye 

2019.2227 

287.96247 

1.67614 

2447616.5750000 

31 

Mar 

1989 

1 

47 

60.00 

Eye 

1453.7324 

310.03127 

8.47978 

2447616.5763889 

31 

Mar 

1989 

1 

49 

60.00 

Eye 

1255.2476 

347.10567 

11.85527 

2447616.5777778 

31 

Mar 

1989 

1 

51 

60.00 

Eye 

1572.0784 

22.20823 

6.90497 

2447616.5791667 

31 

Mar 

1989 

1 

53 

60.00 

Eye 

2187.1330 

40.91777 

0.23711 

2447616.5805556 

31 

Mar 

1989 

1 

55 

60.00 

Eye 

1864.8792 

324.44752 

3.38990 

2447616.6430556 

31 

Mar 

1989 

3 

25 

60.00 

Eye 

1523.1576 

352.34685 

7.61578 

2447616.6444444 

31 

Mar 

1989 

3 

27 

60.00 

Radar 

.  ce 

1604.4964 

25.37638 

6.53800 

2447616.6458333 

31 

Mar 

1989 

3 

29 

60.00 

Radar 

Nlte 

2058.2538 

49.08307 

1.47832 

2447616.6472222 

31 

Mar 

1989 

3 

31 

60.00 

Radar 

Nite 

1784.0513 

325.84264 

4.34185 

2447616.7097222 

31 

Mar 

1989 

5 

1 

60.00 

Radar 

Hite 

1203.1874 

351.09300 

13.03254 

2447616.7111111 

31 

Mar 

1989 

5 

3 

60.00 

Radar 

Nlte 

1072.8630 

37.95255 

15.94504 

2447616.7125000 

31 

Mar 

1989 

5 

5 

60.00 

Radar 

Nite 

1516.2363 

72.78209 

7.76330 

2447616.7138889 

31 

Mar 

1989 

5 

7 

60.00 

Radar 

Nlte 

2207.4577 

88.46757 

0.07867 

2447616.7152778 

31 

Mar 

1989 

5 

9 

60.00 

Radar 

Nite 

1529.2055 

305.01187 

7.58127 

2447616.7763889 

31 

Mar 

1969 

6 

37 

60.00 

Radar 

Nite 

733.4920 

298.41502 

27.84168 

1447616.7777778 

31 

Mar 

1989 

6 

39 

60.00 

Radar 

Nlte 

465.0504 

158.65741 

52.18324 

2447616.7791667 

31 

Mar 

1989 

6 

41 

60.00 

Radar 

Nlte 

1174.0619 

137.56062 

13.58645 

2447616.7805556 

31 

Mar 

1989 

6 

43 

60.00 

Radar 

Nite 

2000.9635 

134.84919 

1.98921 

2447616.7819444 

31 

Mar 

1989 

6 

45 

60.00 

Radar 

Nite 

2030.5947 

268.65142 

1.73611 

2447616.8430556 

31 

Mar 

1989 

8 

13 

60.00 

Radar 

Nite 

1723.6571 

243.14890 

5.02781 

2447616.8444444 

31 

Mar 

1989 

8 

15 

60.00 

Radar 

Nite 

1810.7178 

214.17797 

3.99301 

2447616.8458333 

31 

Mar 

1989 

8 

17 

60.00 

Radar 

Sun 

1963.8213 

0.00000 

0.00000 

2447617.4638889 

31 

Mar 

1989 

23 

7 

60.00 

Radar 

Sun 

1146.1421 

0.00000 

0.00000 

2447617.4652778 

31 

Mar 

1989 

23 

9 

60.00 

Radar 

Sun 

493.2919 

0.00000 

0.00000 

2447617.4666667 

31 

Mar 

1989 

23 

11 

60.00 

Radar 

Sun 

815.0709 

0.00000 

0.00000 

2447617.4680556 

31 

Mar 

1989 

23 

13 

60.00 

Radar 

Sun 

1602.8595 

0.00000 

0.00000 

2447617.4694444 

31 

Har 

1989 

23 

15 

60.00 

Radar 

Sun 

2085.3177 

0.00000 

0.00000 

2447617.5305556 

1 

Apr 

1989 

0 

43 

60.00 

Radar 

Sun 

1387.8890 

0.00000 

0.00000 

2447617.5319444 

1 

Apr 

1989 

0 

45 

60.00 

Radar 

Sun 

970.9358 

0.00000 

0.00000 

2447617.5333333 

1 

Apr 

1989 

0 

47 

60.00 

Radar 

Sun 

1188.6644 

0.00000 

0.00000 

2447617.5347222 

1 

Apr 

1989 

0 

49 

60.00 

Radar 

Sun 

1823.9628 

0.00000 

0.00000 

2447617.5361111 

1 

Apr 

1989 

0 

51 

60.00 

Eye 

1961.9481 

311.26585 

2.32101 

2447617.5986111 

1 

Apr 

1989 

2 

21 

60.00 

Eye 

1548.3600 

336.89933 

7.20644 

2447617.6000000 

1 

Apr 

1989 

2 

23 

60.00 

Bye 

1535.6211 

10.58344 

7.41736 

2447617.6013889 

1 

Apr 

1989 

2 

25 

60.00 

Eye 

1931.5906 

36.89310 

2.71488 

2447617.6027778 

1 

Apr 

1989 

2 

27 

60.00 

Eye 

2123.4635 

320.32474 

0.60735 

2447617.6652778 

1 

Apr 

1989 

3 

57 

60.00 

Eye 

1550.5917 

340.87963 

7.23642 

2447617.6666667 

1 

Apr 

1989 

3 

59 

60.00 

Radar 

Nite 

1309.5397 

15.96171 

10.99226 

2447617.6680556 

1 

Apr 

1989 

4 

1 

60.00 

Radar 

Nlte 

1566.2726 

50.63020 

7.04418 

2447617.6694444 

1 

Apr 

1989 

4 

3 

60.00 

Radar 

Nlte 

2146.5151 

70.72677 

0.62403 

2447617.6708333 

1 

Apr 

1989 

4 

5 

60.00 

Radar 

Nlte 

1929.3774 

314.49818 

2.74961 

2447617,7319444 

1 

Apr 

1989 

5 

33 

60.00 

Radar 

Nlte 

1134.8566 

324.38568 

14.45246 

2447617.7333333 

1 

Apr 

1989 

5 

35 

60.00 

Radar 

Nite 

555.4133 

13.60599 

40.37159 

2447617.7347222 

1 

Apr 

1989 

5 

37 

60.00 

Radar 

Nlte 

895.3790 

95.94735 

20.99377 

2447617.7361111 

1 

Apr 

1989 

5 

39 

60.00 

Radar 

Nlte 

1661.2091 

110.94454 

5.76693 

2447617.7375000 

1 

Apr 

1989 

5 

41 

60.00 
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PREDICT  TE8T  Cast*  Continued 


Epoch  Data  : 

2447616.7557613 

15.23989724 

0.00472400 

0.0015500 

-0.00041255 

47.6897 

17.0000 

-5.16609 

347.8220 

4.8565 

12.18930 


Slta  Data  t  Time  Data  : 

39.007  Latitude  2447616.50 

n  rev/day  -104.883  Longitude  2900.00  min 

ndot  rev/2day2  7219.000  Altitude  ft  2.00  min 

e 

edot  /day 

i 

omega  deg 

omega  dot  deg/day 
argp  deg 

argp  dot  deg/day 
H  deg 


SDI  Test  Vehicle 

Results:  Range  km 

Radar  Sun  2491.3441 

A2 

0.00000 

El 

0.00000 

JD 

2447616.5027778 

31  Mar 

1989 

GMT  Time 

Hr  Min  Sec 
Ot  3:60.00 

Radar 

Sun 

1744.4504 

0.00000 

0.00000 

2447616.5041667 

31  Mar 

1989 

0: 

5t60.00 

Radar 

Sun 

1112.1451 

0.00000 

0.00000 

2447616.5055556 

31  Mar 

1989 

0: 

7:60.00 

Radar 

Sun 

902.7145 

0.00000 

0.00000 

2447616.5069444 

31  Mar 

1989 

0: 

9t60.00 

Radar 

Sun 

1334.8551 

0.00000 

0.00000 

2447616.5083333 

31  Mar 

1989 

0: 

II16O.OO 

Radar 

Sun 

2029.8286 

0.00000 

0.00000 

2447616.5097222 

31  Mar 

1989 

0: 

13:60.00 

Eye 

2436.0022 

295.46095 

1.34202 

2447616.5722222 

31  Mar 

1989 

It 

43t60.00 

Eye 

1751.6968 

308.33154 

9.31720 

2447616.5736111 

31  Mar 

1989 

It 

45t60.00 

Eye 

1244.0800 

335.30518 

18.97421 

2447616.5750000 

31  Mar 

1989 

It 

47:60.00 

Eye 

1181.2137 

20.14299 

20.71962 

2447616.5763889 

31  Mar 

1989 

It 

49:60.00 

Eye 

1616.3785 

51.87490 

11.55082 

2447616.5777778 

31  Mar 

1989 

It 

51:60.00 

Radar 

Nlte 

2275.9654 

66.90337 

3.10551 

2447616.5791667 

31  Mar 

1989 

It 

53t60.00 

Eye 

2118.4894 

306.21328 

4.74582 

2447616.6416667 

31  War 

1989 

3t 

23:60.00 

Eye 

1377.4916 

317.09410 

15.97508 

2447616.6430556 

31  Mar 

1989 

3t 

25i60.00 

Eye 

823.5689 

352.37747 

35.23764 

2447616.6444444 

31  Mar 

1989 

3t 

27:60.00 

Radar 

Nite 

922.0105 

64.56409 

30.06431 

2447616.6458333 

31  Mar 

1989 

3t 

29t60.00 

Radar 

Nlte 

1552.6138 

89.85455 

12.62974 

2447616.6472222 

31  Mar 

1999 

3t 

31t60.00 

Radar 

Nite 

2309.8287 

98.56740 

2.72530 

2447616.6486111 

31  Mar 

1989 

3t 

33t60.00 

Eye 

2455.2075 

295.61743 

1.30786 

2447616.7097222 

31  Mar 

1989 

St 

1:60.00 

Radar 

Nlte 

1677.8918 

289.28005 

10.56793 

2447616.7111111 

31  Mar 

1989 

5t 

3 1 6  0 . 0  0 

Radar 

Nlte 

990.5373 

270.71878 

27.08861 

2447616.7125000 

31  Mar 

1989 

5: 

5:60.00 

Radar 

Nite 

744.6434 

200.51973 

40.51695 

2447616.7138889 

31  Mar 

1989 

5: 

7t60.00 

Radar 

Nite 

1241.5301 

155.71031 

19.05895 

2447616.7152778 

31  Mar 

1989 

5t 

9i60.00 

Radar 

Nite 

1981.1752 

144.22351 

6.29706 

2447616.7166667 

31  Mar 

1989 

5l 

II16O.OO 

Radar 

Nlte 

2589.0907 

269.36919 

0.05152 

2447616.7791667 

31  Mar 

1989 

6t 

41:60.00 

Radar 

Nlte 

2214.0846 

250.77124 

3.68364 

2447616.7805556 

31  Mar 

1989 

6t 

43t60.00 

Radar 

Nlte 

2113.5288 

227.62076 

4.74483 

2447616.7819444 

31  Mar 

1989 

6 1 

45:60.00 

Radar 

Nlte 

2323.9185 

205.66616 

2.46324 

2447616.7833333 

31  Mar 

1989 

6: 

47t60.00 

Radar 

Sun 

2446.8868 

0.00000 

0.00000 

2447617.4861111 

31  Mar 

1989 

23 1 

39:60.00 

Radar 

Sun 

1702.6732 

0.00000 

0.00000 

2447617.4875000 

31  Mar 

1989 

23 1 

41:60.00 

Radar 

Sun 

1082.3864 

O.OOOOQ 

0.00000 

2447617.4888889 

31  Mar 

1989 

23 1 

43i60.00 

Radar 

Sun 

911.3134 

0.00000 

0.00000 

2447617.4902778 

31  Mar 

1989 

23 1 

45t60.00 

Radar 

Sun 

1370.9522 

0.00000 

0.00000 

2447617.4916667 

31  Mar 

1989 

23 1 

47i60.00 

Radar 

Sun 

2073.6509 

0.00000 

0.00000 

2447617.4930556 

31  Har 

1989 

23 1 

49:60.00 

Eye 

2370.5525 

296.30467 

1.89387 

2447617.5555556 

1  Apr 

1989 

It 

19:60.00 

Eye 

1694.4411 

309.99796 

10.03566 

2447617.5569444 

1  Apr 

1989 

li 

21:60.00 

Eye 

1213.4324 

338.87481 

19.55788 

2447617.5583333 

1  Apr 

1989 

It 

23t60.00 

Bye 

1202.0828 

24.03079 

19.91303 

2447617.5597222 

1  Apr 

1989 

It 

25i60.00 

Eye 

1669.9637 

53.78315 

10.52025 

2447617.5611111 

1  Apr 

1989 

It 

27 160.00 

Eye 

2341.3572 

67.86721 

2.30967 

2447617.5625000 

1  Apr 

1989 

It 

29:60.00 

Eye 

2023.2694 

307.10127 

5.72083 

2447617.6250000 

1  Apr 

1989 

2t 

59i60.00 

Eye 

1291.3953 

319.35997 

17.68211 

2447617.6263889 

1  Apr 

1989 

3t 

I16O.OO 

Eye 

786.8104 

1.08699 

37.09810 

2447617.6277778 

1  Apr 

1969 

3t 

3:60.00 

Radar 

Nite 

982.3397 

69.85247 

27.09128 

2447617.6291667 

1  Apr 

1989 

3t 

5t60.00 

Radar 

Nite 

1643.3073 

91.38986 

10.90806 

2447617.6305556 

1  Apr 

1989 

3t 

7:60.00 

Radar 

Nite 

2407. 962S 

99.26161 

1.60714 

2447617.6319444 

1  Apr 

1989 

3 1 

9i60.00 

Eye 

2331.5258 

294.96327 

2.39071 

2447617.6930556 

1  Apr 

1989 

4t 

37:60.00 

Radar 

Nlte 

1559.2440 

287.70281 

12.30580 

2447617.6944444 

1  Apr 

1989 

4t 

39t60.00 

Radar 

Nite 

902.0453 

264.66811 

30.54213 

2447617.6958333 

1  Apr 

1989 

4t 

41:60.00 

Radar 

Nlte 

780.3541 

188.26426 

37.35505 

2447617.6972222 

1  Apr 

1989 

4t 

43:60.00 

Radar 

Nlte 

1348.9459 

152.83354 

16.24654 

2447617.6986111 

1  Apr 

1989 

4t 

45:60.00 

Radar 

Nlte 

2103.6601 

143.14627 

4.68324 

2447617.7000000 

1  Apr 

1989 

4t 

47t60.00 
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INTERPLANETARY  Teat  Caaea 


1. 


Altitude  at  Burnout  200.0  km 

Gravitational  Parameter  Sun  132715440000.0  km3/a2 


Dist  from 

Equatorial 

nu 

V 

vhl 

vh2 

vbo 

vret 

days 

Sun  km 

r  km 

Sun 

0.0 

696000.0  132715440000.0 

Mercury 

57900000.0 

2440.0 

22032.09 

47.876 

7.5343 

9.6137 

13.3400 

10.5058 

105.477 

Venus 

108100000.0 

6051.5 

324858.15 

35.039 

2.5035 

2.7160 

11.2897 

10.6142 

145.983 

Earth 

149599650.0 

6378.1 

398600.43 

29.785 

Mars 

227800000.0 

3389.9 

42828.3 

21.857 

4.1745 

3.5696 

11.7735 

6.1818 

311.804 

Jupiter 

776000000.0 

71492.0 

125686537.0 

13.061 

8.7914 

5.6431 

14.0882 

59.8762 

996.945 

Saturn 

1426000000.0 

60268.0 

37931187.0 

9.647 

10.2877 

5.4432 

15.0674 

35.8643 

2206.984 

Uranus 

2868000000.0 

25662.0 

5793939.0 

6.803 

11.2799 

4.6605 

15.7615 

22.7246 

5849.555 

Neptune  4494000000.0 

24830.0 

6809000.0 

5.434 

11.6532 

4.0549 

16.0308 

25.2362 

11166.384 

Pluto 

5896000000.0 

1150.0 

900.0 

4.744 

11.8129 

3.6889 

16.1472 

10.7638 

16587.827 

J2 

J3 

J4 

J6 

Sun 

Mercury 

Venus 

Earth 

0.00008 

0.00108263 

-0.254x10-5 

-0.161x10-5 

Moon 

Mars 

Jupiter 

0.001964 

0.014736 

0.36x10-4 

-0.587x10-3 

31x10-6 

Saturn 

Uranus 

Neptune 

Pluto 

0.016480 

0.003349 

0.0043 

-0.936x10-2 

-3.8x10-5 

Bills,  Bruce  G.,  Planetary  Geodesy,  Reviews  of  Geophysics,  Vol  25  No  5  pg  833-839 
June  1987. 


TU  Sun  »  54.20765355  days 
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RENDEZVOUS  T**t  Cases 


r  1 

6626.1369008 

6628.1369008 

6628.1369008 


r  2 

42124.0019008 

42124.0019008 

42124.0019008 


Initial 

Revs 

Final 

Wait  Tim* 

145.0000000 

0 

100.7638097 

0.8724 

TU 

145.0000000 

1 

100.7638097 

7.9717 

TU 

86.0000000 

1 

100.7638097 

6.8082 

TU 

6628.1369008 

6628.1369008 

6628.1369008 


6728.1369008 

6728.1369008 

6728.1369008 


145.0000000 

145.0000000 

86.0000000 


0 

1 

1 


2.0027666  119.0353  TU 
2.0027666  418.7104  TU 
2.0027666  369.5970  TU 


Orbit  Chang**  T**t  Cases 


HOHMANN  Astro  321  r«ading 


K 


Orbit  1 

Eccentricity  0.0 

Altitude  191.0  km 


0.0 

191.0  km 


Orbit  2 

Eccentricity 

Altitude 


Orbit  3 

Eccentricity 

Altitude 

DeltaV 

TOF 


0.0 

35780.0  km 

0.497806  DU/TU 
3.935341  ksi/s 
23.454289  TU 
5.256439  hrs 


0.0 

376310.0  km 

0.501684  DU/TU 
3.966000  k*/* 
529.564874  TU 
118.683000  hrs 


ONE  TANGENT  Astro  321  reading 


Orbit  1 


Eccentricity  0.0 

Altitude  191.0  km 

Orbit  2 

Eccentricity 

Altitude 

True  Anomamly  160.0 

Orbit  3 


0.0 

191.0  ksi 


175.0 


Eccentricity 

Altitude 

DeltaV 

TOF 


0.0 

35780.0  km 

0.594466  DU/TU 
4.699481  km/s 
15.426199  TU 
3.457220  hrs 


0.0 

376310.0  km 

0.518508  DU/TU 
4.099000  ks/s 
370.619111  TU 
83.061000  hr* 


BI-EM.IPTIC  Astro  321  reading 


Orbit  1 


Eccentricity 

Altitude 

Ocbit  2 

Eccentricity 

Altitude 


0.0 

191.0  ko 


47836.0  km 


0.0 

191.0  km 


503873.0  km  (79  DU) 


Orbit  3 

Eccentricity 

Altitude 

DeltaV 

TOF 


35780.0  km 

0.530399  DU/TU 
4.193000  km/s 
86.540700  TU 
19.395000  hrs 


376310.0  km  (59  DU) 

0.493858  DU/TU 
3.904128  km/s 
2650.076000  TU 
593.919630  hrs 
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REENTRY 


Vre  =  7200.0  m/s 

Flight  Path  Angle  =  -45.0  deg 

Ballistic  Coeff  =  4500.0  kg/m2 


Alt 

Vel 

g's 

Alt 

vel 

g's 

km 

m/s 

km 

*/• 

1.000 

2108.397 

-54.559 

51.000 

7190.499 

-1.381 

2.000 

2466.629 

-64.996 

52.000 

7191.712 

-1.295 

3.000 

2828.443 

-74.438 

53.000 

7192.771 

-1.220 

4.000 

3187.101 

-82.361 

54.000 

7193.694 

-1.154 

5.000 

3536.872 

-88.418 

55.000 

7194.499 

-1.097 

6.000 

3873.151 

-92.450 

56.000 

7195.202 

-1.048 

7.000 

4192.466 

-94.466 

57.000 

7195.815 

-1.004 

8.000 

4492.403 

-94.606 

58.000 

7196.349 

-0.966 

9.000 

4771.484 

-93.100 

59.000 

7196.816 

-0.933 

10.000 

5029.025 

-90.229 

60.000 

7197.223 

-0.904 

11.000 

5264.984 

-86.290 

61.000 

7197.577 

-0.879 

12.000 

5479.815 

-81.571 

62.000 

7197.887 

-0.857 

13.000 

5674.342 

-76.335 

63.000 

7198.157 

-0.838 

14.000 

5849.643 

-70.811 

64.000 

7198.392 

-0.821 

15.000 

6006.962 

-65.187 

65.000 

7198.596 

-0.807 

16.000 

6147.630 

-59.613 

66.000 

7198.777 

-0.794 

17.000 

6273.012 

-54.203 

67.000 

7198.933 

-0.783 

18.000 

6384.460 

-49.041 

61.000 

7199.069 

-0.773 

19.000 

6483.283 

-44.180 

69.000 

7199.188 

-0.765 

20.000 

6570.727 

-39.655 

70.000 

7199.292 

-0.757 

21.000 

6647.961 

-35.482 

71.000 

7199.312 

-0.751 

22.000 

6716.067 

-31.663 

72.000 

7199.461 

-0.745 

23.000 

6776.040 

-28.192 

73.000 

7199.530 

-0.740 

24.000 

6828.788 

-25.055 

74.000 

7199.590 

-0.736 

25.000 

6875.131 

-22.233 

75.000 

7199.643 

-0.732 

26.000 

6915.809 

-19.706 

76.000 

7199.688 

-0.729 

27.000 

6951.487 

-17.450 

77.000 

7199.728 

-0.726 

28.000 

6982.756 

-15.442 

78.000 

7199.763 

-0.724 

29.000 

7010.144 

-13.660 

79.000 

7199.793 

-0.722 

30.000 

7034.121 

-12.083 

80.000 

7199.820 

-0.720 

31.000 

7055.101 

-10.689 

81.000 

7199.643 

-0.718 

32.000 

7073.451 

-9.459 

82.000 

7199.863 

-0.717 

33.000 

7089.496 

-8.375 

83.000 

7199.880 

-0.716 

34.000 

7103.520 

-7.422 

84.000 

7199.896 

-0.715 

35.000 

7115.775 

-6.584 

85.000 

7199.909 

-0.714 

36.000 

7126.482 

-5.849 

86.000 

7199.921 

-0.713 

37.000 

7135.834 

-5.203 

87.000 

7199.931 

-0.712 

38.000 

7144.000 

-4.638 

88.000 

7199.940 

-0.711 

39.000 

7151.131 

-4.142 

89.000 

7199.947 

-0.711 

40.000 

7157.357 

-3.709 

90.000 

7199.954 

-0.710 

41.000 

7162.791 

-3.329 

91.000 

7199.960 

-0.710 

42.000 

7167.535 

-2.997 

92.000 

7199.965 

-0.710 

43.000 

7171.675 

-2.707 

93.000 

7199.969 

-0.709 

44.000 

7175.288 

-2.453 

94.000 

7199.973 

-0.709 

45.000 

7178.441 

-2.231 

95.000 

7199.977 

-0.709 

46.000 

7181.192 

-2.038 

96.000 

7199.980 

-0.709 

47.000 

7183.592 

-1.868 

97.000 

7199.982 

-0.708 

48.000 

7185.687 

-1.721 

98.000 

7199.985 

-0.708 

49.000 

7187.514 

-1.592 

99.000 

7199.987 

-0.708 

50.000 

7189.108 

-1.479 

100.000 

7199.988 

-0.708 

e*  'jo 


REENTRY  Astro  321  problem 


Vre  =  6504.41  m/s 

Flight  Path  Angle  =  -27.56  deg 
Ballistic  Coeff  =  1200.00  kg/m2 


Alt 

Val 

g's 

Alt 

Val 

g's 

km 

m/s 

km 

m/s 

1.000 

5.706 

-0.464 

51.000 

6455.372 

-2.498 

2.000 

14.026 

-0.470 

52.000 

6461.617 

-2.241 

3.000 

30.734 

-0.495 

53.000 

6467.069 

-2.017 

4.000 

60.920 

-0.575 

54.000 

6471.828 

-1.820 

5.000 

110.647 

-0.785 

55.000 

6475.982 

-1.648 

6.000 

186.211 

-1.258 

56.000 

6479.607 

-1.498 

7.000 

293.214 

-2.182 

57.000 

6482.771 

-1.367 

8.000 

435.682 

-3.775 

58.000 

6485.532 

-1.252 

9.000 

615.432 

-6.227 

59.000 

6487.941 

-1.151 

10.000 

831.808 

-9.647 

60.000 

6490.043 

-1.064 

11.000 

1081.802 

-14.012 

61.000 

6491.877 

-0.987 

12.000 

1360,475 

-19.154 

62.000 

6493.477 

-0.920 

13.000 

1661.554 

-24.780 

63.000 

6494.873 

-0.862 

14.000 

1978.083 

-30.524 

64.000 

6496.091 

-0.811 

15.000 

2303.024 

-36.004 

65.000 

6497.153 

-0.767 

16.000 

2629.738 

-40.883 

66.000 

6498.080 

-0.728 

17.000 

2952.330 

-44.898 

67.0J0 

6498.888 

-0.694 

18.000 

3265.852 

-47.890 

68.000 

6499.594 

-0.665 

19.000 

3566. 3e0 

-49.793 

69.000 

6500.209 

-0.639 

20.000 

3851.002 

-50.632 

70.000 

6500.745 

-0.616 

21.000 

4117.743 

-50.494 

71.000 

6501.214 

-0.597 

22.000 

4365.444 

-49.509 

72.000 

6501.622 

-0.580 

23.000 

4593.630 

-47.831 

73,000 

6501.978 

-0.565 

24.000 

4802.378 

-45.619 

74.000 

6502.289 

-0.552 

25.000 

4992.185 

-43.024 

75.000 

6502.560 

-0.540 

26.000 

5163.854 

-40.183 

76.000 

6502.796 

-0.530 

27.000 

5318.401 

-37.213 

77.000 

6503.002 

-0.522 

28.000 

5456.974 

-34.209 

78.000 

6503.182 

-0.514 

29.000 

5580.786 

-31.248 

79.000 

6503.339 

-0.508 

30.000 

5691.069 

-28.386 

80.000 

6503.476 

-0.502 

31.000 

5789.039 

-25.664 

81.000 

6503.595 

-0.497 

32.000 

5875.867 

-23.109 

82.000 

6503.699 

-0.493 

33.000 

5952.663 

-20.735 

83.000 

6503.790 

-0.489 

34.000 

6020.467 

-18.550 

84.000 

6503.869 

-0.415 

35.000 

6080.237 

-16.553 

85.000 

6503.938 

-0.482 

36.000 

6132.854 

-14.741 

86.000 

6503.999 

-0.480 

37.000 

6179.120 

-13.106 

87.000 

6504.051 

-0.478 

38.000 

6219.759 

-11.636 

88.000 

6504.097 

-0.476 

39.000 

6255.424 

-10.320 

89.000 

6504.137 

-0.474 

40.000 

6286.699 

-9.147 

90.000 

6504.172 

-0.473 

41.000 

6314.105 

-8.103 

91.000 

6504.202 

-0.471 

42.000 

6338.107 

-7.178 

92.000 

6504.229 

-0.470 

43.000 

6359.117 

-6.359 

93.000 

6504.252 

-0.469 

44.000 

6377.499 

-5.635 

94.000 

6504.272 

-0.468 

45.000 

6393.576 

-4.997 

95.000 

6504.290 

-0.468 

46.000 

6407.631 

-4.435 

96.000 

6504.305 

-0.467 

47.000 

6419.916 

-3.941 

97.000 

6504.319 

-0.467 

48.000 

6430.651 

-3.507 

98.000 

6504.330 

-0.466 

49.000 

6440.029 

-3.125 

99.000 

6504.340 

-0.466 

50.000 

6448.219 

-2.791 

100.000 

6504.349 

-0.465 
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HILLS 


Start  at  t=0.0 

r  =  50.0  0.0  0.0  km 
v  =  0.0  0.4738  0.0  km/s 


Altitude  =  180  km 


Time 

Position 

X  km  *  km 

Velocity  Required 

X  ke/i  I  k*/s 

min 

0.0000 

50.00000 

0.00000 

Infinite 

Infinite 

1.0000 

49.79160 

2.84025 

-0.83184 

0.06103 

2.0000 

49.16754 

5.66523 

-0.41369 

0.06079 

3.0000 

48.13116 

8.45976 

-0.27335 

0.06038 

4.0000 

46.68804 

11.20880 

-0.20247 

0.05983 

5'.  0000 
6.0000 

44.84S93 

13.89759 

-0.15942 

0.05912 

42.61474 

16.5116S 

-0.13031 

0.05829 

7.0000 

40.00647 

19.03695 

-0.10919 

0.05732 

8.0000 

37.03513 

21.45989 

-0.09310 

0.05625 

9.0000 

33.71670 

23.76747 

-0.08039 

0.05507 

10.0000 

30.06903 

25.94727 

-0.07006 

0.05381 

11.0000 

26.11172 

27.98756 

-0.06149 

0.05248 

12.0000 

21.86605 

29.87739 

-0.05426 

0,05109 

13.0000 

17.35484 

31.60660 

-0.04808 

0.04966 

14.0000 

12.60235 

33.16587 

-0.04273 

0.04819 

15.0000 

7.63413 

34.54684 

-0.03808 

0.04670 

16.0000 

2.47688 

35.74208 

-0.03399 

0.04519 

17.0000 

-2.84166 

36.74517 

-0.03038 

0.04368 

18.0000 

-8.29290 

37.55070 

-0.02717 

0.04218 

19.0000 

-13.84754 

38.15435 

-0.02432 

0.04069 

20.0000 

-19.47570 

38.55287 

-0.02176 

0.03922 

21.0000 

-25.14715 

38.74413 

-0.01948 

0.03778 

22.0000 

-30.83137 

38.72709 

-0.01742 

0.03636 

23.0000 

-36.49782 

38.50184 

-0.01557 

0.03497 

24.0000 

-42.11602 

38.06960 

-0.01390 

0.03362 

25.0000 

-47.65578 

37.43268 

-0.01238 

0.03231 

26.0000 

-53.08731 

36.59452 

-0.01102 

0.03103 

27.0000 

-58.38141 

35.55962 

-0.00978 

0.02980 

28.0000 

-63.50962 

34.33355 

-0.00865 

0.02860 

29.0000 

-68.44436 

32.92289 

-0.00763 

0.02745 

30.0000 

-73.15911 

31.33522 

-0.00670 

0.02634 

31.0000 

-77.62852 

29.57910 

-0.00585 

0.02526 

32.0000 

-81.82856 

27.66395 

-0.00508 

0.02423 

33.0000 

-85.73665 

25.60007 

-0.00438 

0.02323 

34.0000 

-89.33178 

23.39856 

-0.00374 

0.02227 

35.0000 

-92.59463 

21.07125 

-0.00316 

0.02135 

36.0000 

-95.50764 

18.63066 

-0.00262 

0.02047 

37.0000 

-98.05516 

16.08991 

-0.00213 

0.01962 

38.0000 

-100.22349 

13.46265 

-0.00168 

0.01880 

39.0000 

-102.00098 

10.76302 

-0.00128 

0.01802 

40.0000 

-103.37806 

8.00552 

-0.00090 

0.01726 

41.0000 

-104.34734 

5.20498 

-0.00056 

0.01654 

42.0000 

-104.90361 

2.37646 

-0.00024 

0.01584 

43.0000 

-105.04387 

-0.46484 

0.00005 

0.01517 

44.0000 

-104.76737 

-3.30364 

0.00031 

0.01453 

45.0000 

-104.07559 

-6.12468 

0.00055 

0.01391 

46.0000 

-102.97226 

-8.91279 

0.00078 

0.01332 

47.0000 

-101.46331 

-11.65298 

0.00098 

0.01274 

48.0000 

-99.55685 

-14.33052 

0.00117 

0.01219 

49.0000 

-97.26312 

-16.93102 

0.00134 

0.01166 

50.0000 

-94.59447 

-19.44050 

0.00150 

0.01115 

51.0000 

-91.56523 

-21.84545 

0.00165 

0.01066 

52.0000 

-88.19170 

-24.13297 

0.00178 

0.01019 

53.0000 

-84.49201 

-26.29073 

0.00190 

0.00973 

54.0000 

-80.48605 

-28.30716 

0.00202 

0.00929 

55.0000 

-76.19536 

-30.17139 

0.00212 

0.00887 

56.0000 

-71.64300 

-31.87342 

0.00222 

0.00845 

57.0000 

-66.85345 

-33.40409 

0.00230 

0.00806 

58.0000 

-61.85247 

-34.75517 

0.00238 

0.00767 

S9.0000 

-56.66693 

-35.91940 

0.00246 

0.00730 

60.0000 

-51.32471 

-36.89052 

0.00253 

0.00694 
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HILLS  Kaplan  pg.  114 
Start  at  t=0.0 

r  =  50.0  100.0  0.0  km 

v  =  -0.1885  -0.1101  0.0  km/s 

Altitude  =  222  km 

NOTE!  This  example  does  not  match  Kaplan  since  he  uses  a  YXZ 
coordinate  system*  rather  than  the  XVZ  coordinate  listed  here. 
Using  r  =  100  x  50  y  0  z  will  match  Xaplan. 


Position 

Velocity 

Required 

Time 

X  km 

Y  km 

X  ka/s 

X  ka/s 

min 

1.0000 

50.00000 

100.00000 

-0.95386 

-1.61176 

2.0000 

39.16109 

93.40677 

-0.53620 

-0.78454 

3.0000 

29.28783 

86.79694 

-0.39666 

-0.51293 

4.0000 

20.38005 

80.20579 

-0.32691 

-0.38021 

5.0000 

12.43247 

73.66856 

-0.28526 

-0.30299 

6. 0000 

5.43463 

67.22015 

-0.25782 

-0.25343 

7.0000 

-0.62899 

60.89503 

-0.23861 

-0.21959 

8.0000 

-5.77887 

54.72696 

-0.22466 

-0.19548 

9.0000 

-10.04041 

48.74892 

-0.21428 

-0.17774 

10.0000 

-13.44374 

42.99282 

-0.20645 

-0.16436 

11.0000 

-16.02357 

37.48942 

-0.20053 

-0.15406 

12.0000 

-17.81902 

32.26813 

-0.19606 

-0.14597 

13.0000 

-18.87339 

27.35682 

-0.19273 

■0.13950 

14.0000 

-19.23394 

22.78174 

-0.19031 

-0.13421 

15.0000 

-18.95165 

18.56733 

-0.18861 

-0.12981 

16.0000 

-18.08092 

14.73610 

-0.18751 

-0.12606 

17.0000 

-16.67929 

11.30852 

-0.18690 

-0.12278 

18.0000 

-14.80715 

8.30290 

-0.1866) 

-0.11986 

19.0000 

-12.52739 

5.73530 

-0.1867!) 

-0.11719 

20.0000 

-9.90509 

3.61942 

-0.18715 

-0.11469 

21.0000 

-7.00716 

1.96658 

-0.18774 

-0.11231 

22.0000 

-3.90197 

0.78560 

-0.18850 

-0.11001 

23.0000 

-0.65900 

0.08279 

-0.18941 

-0.10775 

24.0000 

-0.19042 

-0.10550 

25.0000 

-0.19153 

-0.10325 

26.0000 

-.0.19270 

-0.10099 

27.0000 

'-0.19392 

-0.09870 

28.0000 

-0.19517 

-0.09638 

29.0000 

-0.19645 

-0.09402 

30.0000 

-0.19774 

-0.09162 

GROUND  TRACK 


Time 

Lat 

Don 

TU 

0.0000 

35.38473 

35.66651 

0.0996 

38.82047 

41.15173 

0.1992 

41.99389 

47.04525 

0.2989 

44.81139 

53.35574 

0.3985 

47.16810 

60.06468 

0.4981 

48.95761 

67.11902 

0.5977 

50.08645 

74.42837 

0.6974 

50.49057 

81.86994 

0.7970 

50.14850 

89.30234 

0.8966 

49.08620 

96.58508 

0.9962 

47.37135 

103.59781 

1.0958 

45.09951 

110.25328 

1.1955 

42.37775 

116.50158 

1.2951 

39.31048 

122.32669 

1.3947 

35.99018 

127.73894 

1.4943 

32.49317 

132.76637 

1.5940 

28.87903 

137.44729 

1.6936 

25.19216 

141.82476 

1.7932 

21.46426 

145.94291 

1.8928 

17.71699 

149.84481 

1.9924 

13.96435 

153.57148 

2.0921 

10.21473 

157.16155 

2.1917 

6.47250 

160.65139 

2.2913 

2.73938 

164.07549 

2.3909 

-0.98450 

167.46696 

2.4906 

-4.69970 

170.85810 

2.5902 

-8.40665 

174.28099 

2.6898 

-12.10479 

177.76804 

2.7894 

-15.79175 

-178.64751 

2.8890 

-19.46230 

-174.93116 

2.9887 

-23.10716 

-171.04692 

3.0883 

-26.71154 

-166.95731 

3.1879 

-30.25345 

-162.62390 

3.2875 

-33.70176 

-158.00838 

3.3872 

-37.01417 

-153.07466 

3.4868 

-40.13562 

-147.79221 

3.5864 

-42.99752 

-142.14073 

3.6860 

-45.51901 

-136.11617 

3.7856 

-47,61109 

-129.73716 

3.8853 

-49.18446 

-123.05028 

3.9849 

-50.16065 

-116.13180 

4.0845 

-50.48443 

-109.08385 

4.1841 

-50.13396 

-102.02422 

4.2838 

-49.12512 

-95.07183 

4.3834 

-47.50828 

-88.33190 

4.4830 

-45.35884 

-81.88488 

4.5826 

-42.76493 

-75.78163 

4.6822 

-39.81587 

-70.04441 

4.7819 

-36.59381 

-64.67183 

4.8815 

-33.16903 

-59.64514 

4.9811 

-29.59837 

-54.93440 

5.0807 

-25.92573 

-50.50339 

5.1803 

-22.18360 

-46.31310 

5.2800 

-18.39508 

-42.32394 

5.3796 

-14.57584 

-38.49701 

5.4792 

-10.73595 

-34.79462 

5.5788 

-6.88135 

-31.18029 

5.6785 

-3.01521 

-27.61856 

5.7781 

0.86099 

-24.07454 

5.8777 

4.74642 

-20.51337 

5.9773 

8.63993 

-16.89962 

6.0769 

12.53902 

-13.19675 

6.1766 

16.43863 

-9.36655 

6.2762 

20.32977 

-5.36874 

6.3758 

24.19776 

-1.16092 

6.4754 

28.02017 

3.30118 

6.5751 

31.76434 

8.06255 

6.6747 

35.38473 

13.16672 

6.7743 

38.82047 

18.65194 

Orbit  Blamants 

p  =  1.04084 
a  *  1.04112 
•  =  0.01637 
1  x  45.00000 
Omaga  *  3.07915 
Argp  =  50.99729 
Nu  =  0.00000 

M  x  0.00000 

U  *  Undaflnad 
L  x  undaflnad 
Cappl  1  Undaflnad 


Tima 

31  Mar  1982  12»00i00.00 
or 

2445060.0 
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PW 


Cowells  Method  Results 


Init  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420 


Simulate  from 
Period  = 
Dt  = 
Julian  Date  = 


0.000  TU  to 
6.6639216  TU 
0.5000000  TU 
2447538.5000000 


6.664  TU 


RK4t  6.664  -0.52729937 


RK4p 

Kep 


-0.52531386 

-0.50960117 


0.48752671  0.71759037  -0.69471172  -0.72206412 
0.48973595  0.71755114  -0.69857574  -0.71828295 
0.50959883  0.72068320  -0.70738340  -0.70738500 


32  Pert 

-0.0011287 

0.0011287 

-0.0005321 

0.0016826 

a 

Two  Body 

RK4  Two  Body 

RK4  Perturbed 

2-Body  Delta 

a 

1.03999983 

1.03557220 

1.03557748 

-4.42762632B-03 

e 

0.01999986 

0.01966154 

0.01965897 

-3.38319377B-04 

i 

44.99999875 

44.99999875 

44.95957681 

-3.46944695B-18 

w 

Omega 

45.00000000 

45.00000000 

44.61191529 

0.000000008+00 

Argp 

90.00000000 

90.37079536 

90.71715645 

3.707953561-01 

Nu 

0.00009311 

1.21661635 

0.97722655 

1.21652324K+00 

J 

M 

0.00008944 

1.16947502 

0.93936498 

1.169385588+00 

Init  0.000 

-0.50960000 

0.50960000  0. 

72068320  -0.70738420  -0.70738420 

Simulate  from  0.000 

TU  to  6.664 

TU 

Period 

=  6.6639216  TU 

Dt 

=  0.1000000  TU 

Julian  Date  =  2447538. 

5000000 

: 

RK4t  6.664 

-0.50961330 

0.50958551  0. 

72068236  -0.70737485  -0.70739428 

i 

RK4p 

-0.50754460 

0.51164801  0. 

72068130  -0.71110417  -0.70364354 

Kep 

-0.50960117 

0.50959883  0. 

72068320  -0.70738340  -0.70738500 

32  Pert 

-0.0011287 

0.0011287 

-0.0005321 

0.0016826 

Two  Body 

RK4  Two  Body 

RX4  Perturbed 

2-Body  Delta 

a 

1.03999983 

1.03999847 

1.03999848 

-1.35829689S-06 

- 

e 

0.01999986 

0.01999972 

0.01999972 

-1.38866838B-07 

i 

44.99999875 

44.99999875 

44.99999878 

-3.469446958-18 

Omega 

45.00000000 

45.00000000 

44.61804864 

1.387778788-17 

Argp 

90.00000000 

90.00153899 

90.40780034 

1.538986218-03 

* 

Mu 

0.00009311 

359.99956547 

359.69916484 

3.599994728+02 

M 

0.00008944 

359.99958260 

359.71101989 

3.599994938+02 

Init  0.000 

-0.50960000 

0.50960000  0. 

72068320  -0.70738420  -0.70738420 

k‘ 

Simulate  from  0.000 

TU  to  6.664 

TU 

Period 

=  6.6639216  TU 

Dt 

=  0.0500000  TU 

Julian  Date  =  2447538. 

5000000 

RK4t  6.664 

-0.50960180 

0.50959816  0. 

72068317  -0.70738295  -0.70738547 

RK4p 

-0.50753307 

0.51166055  0. 

72068214  -0.71111218  -0.70363476 

' 

Kep 

-0.50960117 

0.50959883  0. 

72068320  -0.70738340  -0.70738500 

J2  Port 

-0.0011287 

0.0011287 

-0.0005321 

0.0016826 

Two  Body 

RK4  Two  Body 

RK4  Perturbed 

2-Body  Delta 

a 

1.03999983 

1.03999979 

1.03999979 

-4.273072098-08 

> 

e 

0.01999986 

0.01999985 

0.01999986 

-4.527592138-09 

i 

44.99999875 

44.99999875 

44.99999891 

1.040834098-17 

Omega 

45.00000000 

45.00000000 

44.61805286 

6. 938893908-18 

Argp 

90.00000000 

90.00010762 

90.40640319 

1.076249408-04 

; 

Nu 

0.00009311 

0.00003711 

359.69960253 

-5.600714668-05 

f 

M 

0.00008944 

0.00003564 

359.71144041 

-5.380003978-05 

-0.00000000 


-0.01934106 

-0.02072045 

-0.00000113 


Perturbed  Delta 
-4.422343568B-03 
-3. 4088806 2SB-04 
-4.219406789E-04 
-3.880847054B-01 
7.171564452K-01 
9.771334399B-01 
9.392755402B-01 


-0.00000000 


-0.00001374 

-0.00139344 

-0.00000113 


Perturbed  Delta 
-1 . 3507  46001K-06 
-1.3628933358-07 
3.000315298B-08 
-3 . 819513566E-01 
4.0780034481-01 
3.5969907171+02 
3.597109304B+02 


-0.00000000 


-0.00000178 

-0.00138148 

-0.00000113 


Perturbed  Delta 
-3.656743611Z-08 
-7.7397664358-10 
1.5992990938-07 
-3.8194714148-01 
4.064031902E-01 
3.5969950948+02 
3.5971135108+02 
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Cowells  Method  Results 


Xnit  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420  -0.00000000 

Simulate  from  0.000  TU  to  6.664  TU 

Period  =  6. 66392’ 6  TU 

Dt  =  0.0100000  TU 

Julian  Date  =  2447538.5000000 

RK4t  6.664  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000115 

RK4p  -0.50753246  0.51166120  0.72068217  -0.71111261  -0.70363431  -0.00138085 

Kep  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000114 

J2  Pert  -0.0011287  0.0011287  -0.0005321  0.0016826 


Two  Body  RK4  Two  Body  RK4  Perturbed  2-Body  Delta  Perturbed  Delta 
a  1.03999983  1.03999983  1.03999983  -1.36933949E-11  6.100741141E-09 

e  0.01999986  0.01999986  0.01999986  -1.46594793E-12  3.782742394E-09 

i  44.99999875  44.99999875  44.99999892  3.46944695E-18  1.640886736E-07 

Omega  45.00000000  45.00000000  44.61805309  -1.04083409E-17  -3.819469054E-01 

Argp  90.00000000  90.00000018  90.40629761  1.76977928E-07  4.062976113B-01 

Nu  0.00009459  0.00009448  359.69965807  -1.09209965E-07  3.596995635E+02 

M  0.00009087  0.00009076  359.71149377  -1.04906263E-07  3.597114029E+02 


Init  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420  -0.00000000 

Simulate  from  0.000  TU  to  6.664  TU 

Period  =  6.6639216  TU 

Dt  =  0.0050000  TU 

Julian  Date  =  2447538.5000000 

RK4t  6.664  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000115 

RK4p  -0.50753246  0.51166120  0.72068217  -0.71111261  -0.70363430  -0.00138085 

Kep  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000114 

J2  Pert  -0.0011287  0.0011287  -0.0005321  0.0016826 


Two  Body  RK4  Two  Body  RK4  Perturbed  2-Body  Delta  Perturbed  Delta 
a  1.03999983  1.03999983  1.03999983  -4.28004420E-13  6.U3985862B-09 
e  0.01999986  0.01999986  0.01999986  -4.58862684B-14  3.784171819E-09 
i  44.99999875  44.99999875  44.99999892  O.OOOOOOOOE+OO  1.640898162E-07 
Omega  45.00000000  45.00000000  44.61805309  5.89805982SS-17  -3.819469051E-01 
Argp  90.00000000  90.00000002  90.40629745  1.88659105E-08  4.062974478E-01 
Nu  0.00009459  0.00009459  359.69965817  -6.97997142E-09  3.596995636E+02 
M  0.00009087  0.00009086  359.71149387  -6.70490757B-09  3.597114030E+02 


E-44 


•  ■>  f  ,  •  ♦’  * 

.  '»’/  •«  A.  ’ 

.  .  '  ►  ■ 

Cowelis  Method  Results  '  ■ 

Init  0.000  -0.50960000  0.50960000  0. 72068320 '-*0. 70738420  -0.70738420 

Simulate  from  0.000  TU  to  6.664  TU  '  ■  ■ 

Period  =  6.6639216  TU 

Dt  =  0.0100000  TU 

Julian  Dale  =  2441538.5000000  '  \  .• 

RK4t  6.664  -0.50960119  0.50959881  0.72068320  -0-.  70738339  -0.70738501 


RK4p 

Kep 

J2  Pert 


-0.50753246  0.51166120  0.72068217  -0.71111261  -0.70363431 
-0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501 


-0.0011287 


0.0011287 


-0.0005321 


0.0016626 


* 

f 


Two  Body 

RK4  Two  Body 

RX4  Perturbed 

2-Body  Delta 

a 

1.03999983 

1.03999983 

1.03999983 

-1.36933949E-11 

e 

0.01999986 

0.01999986 

0.01999986 

-1.46594793E-12 

1 

44.99999875 

44.99999875 

44.99999892 

3.46944695E-18 

Omega 

45.00000000 

45.00000000 

44.61805309 

-1.04083409E-17 

Argp 

90.00000000 

90.00000018 

90.43629761 

1.76977928E-07 

Mu 

0.00009459 

0.00009448 

359.69965807 

-1.09209965E-07 

M 

0.00009087 

0.00009076 

359.71149377 

-1.04906263E-07 

f  Inlt  0.000  -0.50960000  0.50960000  0.72068320  -0.70736420  -0.70738420 

I 

Simulate  from  0.000  TU  to  6.664  TU 
i  Period  =  6.6639216  TU 

Dt  =  0.0100000  TU 

f  Julian  Date  =  2447538.5000000 

RK4t  6.664  -0.50960x19  0.50959881  0.72068320  -0.70738339  -0.70738501 

r  RK4p  -0.509358/8  0.50984119  0.72068318  -0.70751242  -0.70725590 

Kep  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501 


J3  Pert 


a 

o 

1 

Omega 

Argp 

Mu 

M 


0.0000010 


Two  Body 
1.03999983 
0.01999986 
44.99999875 
45.00000000 
90.00000000 
0.00009459 
0.00009087 


-0.0000010 


RK4  Two  Body 
1.03999983 
0.01999986 
44.99999875 
45.00000000 
90.000C0018 
0.00009441 
0.00009076 


-0.0000043 


RK4  Perturbed 
1.03993984 
0.02000000 
44.99999889 
44.99994908 
90.21138580 
359.76947415 
359.77855866 


0.0000046 


2-Body  Delta 
1. 369339458-11 
1.46594793E-12 
3.46944695E-18 
1.04083409K-17 
1.76977928E-07 
1.0D209965E-07 
■1.04906263E-Q7 


Inlt  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420 


Simulate  from 
Period  = 
Dt  - 
Jul  ian  Date  = 


0.000  TU  to 
6.6639216  TU 
0.0100000  TU 
2447538.5000000 


6.664  TU 


RK4t  6.664  -0.50960119  0.50959881 
RK4p  -0.50961634  0.50958366 
Kep  -0.50960119  0.50959861 


0.72068320  -0.70738339  -0.7073850r 
0.72068320  -0.70737189  -0.70739651 
0.72068320  -0.70738339  -0.70738501 


J4  Pert 


O.OCUOOIO  -0.0000010  -0.0000027 


0.0000031 


f 

5 

l 


Two  Body 

RK4  TWO  Body 

RK4  Perturbed 

2-Body  Delta 

a 

1.03999983 

1.03999983 

1.03999983 

-1.36933949E-11 

e 

0.01999986 

0.01999986 

0.01999986 

-1 . 46594793E-12 

1 

44.99999875 

44.99999675 

44.99999875 

3 . 46944695E-18 

Omega 

45.00000000 

45.00000000 

45.00016451 

-1.04083409E-17 

Argp 

90.00000000 

90.00000018 

90.00093124 

1.76977928B-07 

Mu 

0 . 00009  459 

0.00009448 

0.00025130 

-1.09209965E-07 

M 

0.00009087 

0.00009076 

0.00024140 

-1.04906263E-07 

-0.00000000 


-0.00000115 

-0.00138085 

-0.00000114 


Perturbed  Delta 
6.100741141E-09 
3.782742394E-09 
1.640886736E-07 
-3.81S469054E-01 
4.062976113E-01 
3. 596995635E+02 
3 . 597114029E+02 


-0.00000000 


-O.OOQOOllS 

0.00018050 

-0.00000114 


Perturbed  Delta 
1.047092290E-08 
1 . 361629665E-07 
1.327148725E-07 
-5.09239323DK-05 
2.113857966E-01 
3.597693796E+02 
3.597784678B+02 


-0.00000000 


-0.00000115 

-0.00001454 

-0.00000114 


Perturbed  Delta 
-1.369318222B-11 
1.834034S99E-13 
-1.877383665E-12 
1 . 645143718E-04 
9.3123829978-04 
1.567107277B-04 
1.505351358B-04 
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Cowells  Method  Results 


Init  0.00G  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420  -0.00000000 

Simulate  from  0.000  TU  to  6.664  TU 

Period  =  6.6639216  TU 

Dt  =  0.0100000  TU 

Julian  Date  =  2447538.5000000 

RK4t  6.664  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000115 

RK4p  -0.50960129  0.50959873  0.72068317  -0.70738337  -0.70738504  -0.00000130 

Kep  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70736501  -0.00000114 

Sun  -0.00C.ln.00  0.0000000  0.0000000  0.0000001 


Two  Body  RK4  Two  Body  RK4  Perturbed  2-Body  Delta  Perturbed  Delta 
a  1.03999983  1.03999983  1.03999983  -1.36933949S-11  3.410645269F.-11 
e  0.01999986  0.01999986  0.01999987  -1.46594793E-12  8.620236502K-09 
i  44.99999875  44.99999875  44.99999679  3.46944695E-18  -1.962326295E-06 
Omega  45.00000000  45.00000000  44.99999286  -1.04083409E-17  -7.137930274E-06 
Argp  90.00000000  90.00000018  90.00003732  1.76977928E-07  3.732088150E-05 
Nu  0.00009459  0.00009448  0.00006956  -1.09209965E-07  -2.503655785E-05 
M  0.00009087  0.00009076  0.00006682  -1.04906263E-07  -2.404992864E-05 


init  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420  -0.00000000 

Simulate  from  0.000  TU  to  6.664  TU 

Period  =  6.6639216  TU 

Dt  =  0.0100000  TU 

Julian  Date  =  2447538.5000000 

RK4t  6.664  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000115 

RK4p  -0.50960051  0.50959885  0.72068344  -0.70738336  -0.70738462  -0.00000106 

Kep  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000114 

Moon  -0.0000002  -0.0000000  -0.0000000  0,0000002 


Two  Body  RK4  TWO  Body  RK4  Perturbed  ?-Body  Delta  Perturbed  Delta 
a  1,03999983  1.03999983  1.03999962  -1.36933949B-11  -2.062930837B-07 

e  0.01999986  0.01999986  0.01999981  -1.46594793E-12  -4.600062723E-08 

i  44.99999875  44.99999875  45.00002620  3. 46944695E-18  2.744984133E-05 

Omega  45.00000000  45.00000000  44.99997014  -1.04083409E-17  -2.966394181E-05 

Argp  90.00000000  90.00000018  90.00003675  1.76977928E-07  3.674635770E-05 

Nu  0.00009459  0.00009448  0.00005009  -1.09209965B-07  -4.449951920E-05 

M  0.00009087  0.00009076  0.00004812  -1.04906263E-07  -4.2745B9598E-05 


Ballistic  Coefficient  -  365.8536585  kg/m2 

Init  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420  -0.00000000 

Simulate  from  0.000  TU  to  6.664  TU 

Period  =  6.6639216  TU 

Dt  =  0.0100000  TU 

Julian  Date  =  2447538.5000000 

RK4t  6.664  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000115 

RK4p  -0.51002355  0.50916450  0.72067414  -0.70705869  -0.70764340  -0.00041346 

Kep  -0.50960119  0.50959881  0.72068320  -0.70738339  -0.70738501  -0.00000114 

Drag  0.0000394  0.0000394  0.0000000  0.0000557 


Two  Body  RK4  Two  Body  RK4  Perturbed  2-Body  Delta  Perturbed  Delta 
a  1.03999983  1.03999983  1.03987334  -1.36933949E-11  -1.264920157B-04 

e  0.01999986  0.01999986  0.01989239  -1 . 46594793E-12  -1. 0747189578-04 

i  44.99999875  44.99999875  44.99997419  3.469446958-18  -2.4560346748-05 

Omega  45.00000000  45.00000000  44.99999980  -1.040834098-17  -1.9857076088-07 

Argp  90.00000000  90.00000018  90.00040346  1.76977928E-07  4.034605799E-04 

Nu  0.00009459  0.00009448  0.03374512  -1.092099658-07  3.365052897E-02 

M  0.00009087  0.00009076  0.0324223S  -1 .04906263E-07  3.233148336E-02 
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Cowells  Method  Results 


liilt  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420  -0.00000000 

6.664  TU 


Simulate  from 
Period  - 
Dt  = 
Julian  Date  = 


0.000  TU  to 
6.6639216  TU 
0.0100000  TU 
2447538.5000000 


HK4l  6.664 

RK4p 

Kep 


-0.50960119 

-0.50960122 

-0.50960119 


0.S09S9E81 

0.50959879 

0.50959881 


0.72068320  -0.70738339  -0.70738501  -0.00000115 
0.72068320  -0.70738337  -0.70738502  -0.00000116 
0.72068320  -0.70738339  -0.70738501  -0.00000114 


"1 


* 


Solar 

-0.0000000 

0.0000000 

0.0000000 

0.0000000 

Two  Body 

RK4  Two  Body 

RK4  Perturbed 

2-Body  Delta 

Perturbed  Delta 

a 

1.03999983 

1.03999983 

1.03999983 

-1.369339498-11 

-1.325367778E-11 

e 

0.01999986 

0.01999986 

0.01999986 

-1.46594793E-12 

-3. 2048860618-09 

i 

44.99999875 

44.99999875 

44.99999875 

3. 469446958-18 

-2.539041546E-11 

Omega 

45.00000000 

45.00000000 

45.00000001 

-1. 040834098-17 

5. 3538527058-09 

Argp 

90.00000000 

90.00000018 

89.99997661 

1.769779288-07 

-2. 3392724808-05 

Nu 

0.00009459 

0.00009448 

0.00012002 

-1.092099658-07 

2.5429865918-05 

M 

0.00009087 

0.00009076 

0.00011529 

-1.049062638-07 

2.4427736968-05 

Ini t  0.000  -0.50960000  0.50960000  0.72068320  -0.70738420  -0.70738420  -0.00000000 


Simulate  from 
Period  = 
Dt  = 
Julian  Date  = 


0.000  TU  to  6.664  TU 
6.6639216  TU 
0.0100000  TU 
2447538.5000000 


RK4t  6.664 

-0.50960119 

0.50959881  0. 

72068320  -0.70738339  -0.70738501 

-0.00000115 

RK4p 

-0.50772080 

0.51146328  0. 

72067363  -0.71091336  -0.20377026 

-0.00161726 

Hop 

-0.50960119 

0.50959881  0. 

72068320  -0.70738339  -0.70738501 

-0.00000114 

J7  Port 

-0.0011287 

0.0011287 

-0.0005321 

0.0016826 

J3  Pert 

0.0000010 

-0.0000010 

-0.0000043 

0.0000046 

J4  Pert 

0.0000010 

-0.0000010 

-0.0000027 

0.0000031 

Sun 

-0.0000000 

0.0000000 

0.0000000 

0.0000001 

Moon 

-0.0000002 

-0.0000000 

-0.0000000 

0.0000002 

Drag 

0.0000394 

0.0000394 

0.0000000 

0.0000557 

Solar 

-0.0000000 

0. 0000000 

0.0000000 

0.0000000 

Two  Body 

RK4  Two  Body 

RX4  Perturbed 

2-Body  Delta 

Perturbed  Delta 

a 

1.03999983 

1.03999983 

1.03987702 

-1 . 36933949E-11 

-1 . 228044552E-04 

e 

0.01999986 

0.01999986 

0.01989571 

-1.465947938-12 

-1.041513196B-04 

i 

44.99999875 

44.99999875 

45.00000095 

3.469446958-18 

2. 202087974E-06 

Omega 

45.00000000 

45.00000000 

44.61807138 

-1.040834098-17 

-3.8192861958-01 

Argp 

90.00000000 

90.00000018 

90.61870002 

1.769779288-07 

6 . 187000175E-01 

Nu 

0.00009459 

0.00009448 

359.50259568 

-1.092099658-07 

3.595025011E+02 

M 

0.00009087 

0.00009076 

359.52209638 

-1.049062638-07 

3.595220055E+02 

« 
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